diff --git a/.gitignore b/.gitignore index 00f2d38..f833587 100644 --- a/.gitignore +++ b/.gitignore @@ -1,3 +1,24 @@ +# Python __pycache__/ -*.pyc +*.py[cod] +.pytest_cache/ .venv/ +venv/ + +# IDE / OS +.idea/ +.vscode/ +.DS_Store +Thumbs.db + +# Raw data and generated outputs +data/raw/ +work/ +outputs/ +*.rscap +*.dorec +*.log + +# Large generated point clouds outside the archived reference result +**/frames/ +**/frames_all/ diff --git a/CONSENSUS_SELECTION.md b/CONSENSUS_SELECTION.md deleted file mode 100644 index eb46fba..0000000 --- a/CONSENSUS_SELECTION.md +++ /dev/null @@ -1,12 +0,0 @@ -# 最终推荐值补充说明 - -两套后端各自结果均保留。最终推荐值又增加了一层不依赖外参X的交叉检查:只有同一运动对的Open3D B与small_gicp B相差不超过5 cm、0.5°时才进入最终求解;最终B数为39对。 - -最终推荐: - -- 平移 `[1.297760, -0.000067, 0.720498] m` -- RPY `[-0.785151, 1.202661, -0.835510] deg` -- 第二批AX RMS:`0.07985 m / 0.96118°` -- 第一批22对辅助复核:`0.06067 m / 1.00298°` - -完整结果见 `results/final_extrinsic_recommended.json`,选择摘要见 `results/final_summary.json`。执行完整 `run_all.ps1` 后,再执行 `run_consensus_finish.ps1` 可重建最终推荐结果。 diff --git a/LICENSE b/LICENSE deleted file mode 100644 index f63f5a9..0000000 --- a/LICENSE +++ /dev/null @@ -1,194 +0,0 @@ -木兰宽松许可证,第2版 - -木兰宽松许可证,第2版 - -2020年1月 http://license.coscl.org.cn/MulanPSL2 - -您对“软件”的复制、使用、修改及分发受木兰宽松许可证,第2版(“本许可证”)的如下条款的约束: - -0. 定义 - -“软件” 是指由“贡献”构成的许可在“本许可证”下的程序和相关文档的集合。 - -“贡献” 是指由任一“贡献者”许可在“本许可证”下的受版权法保护的作品。 - -“贡献者” 是指将受版权法保护的作品许可在“本许可证”下的自然人或“法人实体”。 - -“法人实体” 是指提交贡献的机构及其“关联实体”。 - -“关联实体” 是指,对“本许可证”下的行为方而言,控制、受控制或与其共同受控制的机构,此处的控制是 -指有受控方或共同受控方至少50%直接或间接的投票权、资金或其他有价证券。 - -1. 授予版权许可 - -每个“贡献者”根据“本许可证”授予您永久性的、全球性的、免费的、非独占的、不可撤销的版权许可,您可 -以复制、使用、修改、分发其“贡献”,不论修改与否。 - -2. 授予专利许可 - -每个“贡献者”根据“本许可证”授予您永久性的、全球性的、免费的、非独占的、不可撤销的(根据本条规定 -撤销除外)专利许可,供您制造、委托制造、使用、许诺销售、销售、进口其“贡献”或以其他方式转移其“贡 -献”。前述专利许可仅限于“贡献者”现在或将来拥有或控制的其“贡献”本身或其“贡献”与许可“贡献”时的“软 -件”结合而将必然会侵犯的专利权利要求,不包括对“贡献”的修改或包含“贡献”的其他结合。如果您或您的“ -关联实体”直接或间接地,就“软件”或其中的“贡献”对任何人发起专利侵权诉讼(包括反诉或交叉诉讼)或 -其他专利维权行动,指控其侵犯专利权,则“本许可证”授予您对“软件”的专利许可自您提起诉讼或发起维权 -行动之日终止。 - -3. 无商标许可 - -“本许可证”不提供对“贡献者”的商品名称、商标、服务标志或产品名称的商标许可,但您为满足第4条规定 -的声明义务而必须使用除外。 - -4. 分发限制 - -您可以在任何媒介中将“软件”以源程序形式或可执行形式重新分发,不论修改与否,但您必须向接收者提供“ -本许可证”的副本,并保留“软件”中的版权、商标、专利及免责声明。 - -5. 免责声明与责任限制 - -“软件”及其中的“贡献”在提供时不带任何明示或默示的担保。在任何情况下,“贡献者”或版权所有者不对 -任何人因使用“软件”或其中的“贡献”而引发的任何直接或间接损失承担责任,不论因何种原因导致或者基于 -何种法律理论,即使其曾被建议有此种损失的可能性。 - -6. 语言 - -“本许可证”以中英文双语表述,中英文版本具有同等法律效力。如果中英文版本存在任何冲突不一致,以中文 -版为准。 - -条款结束 - -如何将木兰宽松许可证,第2版,应用到您的软件 - -如果您希望将木兰宽松许可证,第2版,应用到您的新软件,为了方便接收者查阅,建议您完成如下三步: - -1, 请您补充如下声明中的空白,包括软件名、软件的首次发表年份以及您作为版权人的名字; - -2, 请您在软件包的一级目录下创建以“LICENSE”为名的文件,将整个许可证文本放入该文件中; - -3, 请将如下声明文本放入每个源文件的头部注释中。 - -Copyright (c) [Year] [name of copyright holder] -[Software Name] is licensed under Mulan PSL v2. -You can use this software according to the terms and conditions of the Mulan -PSL v2. -You may obtain a copy of Mulan PSL v2 at: - http://license.coscl.org.cn/MulanPSL2 -THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY -KIND, EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO -NON-INFRINGEMENT, MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE. -See the Mulan PSL v2 for more details. - -Mulan Permissive Software License,Version 2 - -Mulan Permissive Software License,Version 2 (Mulan PSL v2) - -January 2020 http://license.coscl.org.cn/MulanPSL2 - -Your reproduction, use, modification and distribution of the Software shall -be subject to Mulan PSL v2 (this License) with the following terms and -conditions: - -0. Definition - -Software means the program and related documents which are licensed under -this License and comprise all Contribution(s). - -Contribution means the copyrightable work licensed by a particular -Contributor under this License. - -Contributor means the Individual or Legal Entity who licenses its -copyrightable work under this License. - -Legal Entity means the entity making a Contribution and all its -Affiliates. - -Affiliates means entities that control, are controlled by, or are under -common control with the acting entity under this License, ‘control’ means -direct or indirect ownership of at least fifty percent (50%) of the voting -power, capital or other securities of controlled or commonly controlled -entity. - -1. Grant of Copyright License - -Subject to the terms and conditions of this License, each Contributor hereby -grants to you a perpetual, worldwide, royalty-free, non-exclusive, -irrevocable copyright license to reproduce, use, modify, or distribute its -Contribution, with modification or not. - -2. Grant of Patent License - -Subject to the terms and conditions of this License, each Contributor hereby -grants to you a perpetual, worldwide, royalty-free, non-exclusive, -irrevocable (except for revocation under this Section) patent license to -make, have made, use, offer for sale, sell, import or otherwise transfer its -Contribution, where such patent license is only limited to the patent claims -owned or controlled by such Contributor now or in future which will be -necessarily infringed by its Contribution alone, or by combination of the -Contribution with the Software to which the Contribution was contributed. -The patent license shall not apply to any modification of the Contribution, -and any other combination which includes the Contribution. If you or your -Affiliates directly or indirectly institute patent litigation (including a -cross claim or counterclaim in a litigation) or other patent enforcement -activities against any individual or entity by alleging that the Software or -any Contribution in it infringes patents, then any patent license granted to -you under this License for the Software shall terminate as of the date such -litigation or activity is filed or taken. - -3. No Trademark License - -No trademark license is granted to use the trade names, trademarks, service -marks, or product names of Contributor, except as required to fulfill notice -requirements in section 4. - -4. Distribution Restriction - -You may distribute the Software in any medium with or without modification, -whether in source or executable forms, provided that you provide recipients -with a copy of this License and retain copyright, patent, trademark and -disclaimer statements in the Software. - -5. Disclaimer of Warranty and Limitation of Liability - -THE SOFTWARE AND CONTRIBUTION IN IT ARE PROVIDED WITHOUT WARRANTIES OF ANY -KIND, EITHER EXPRESS OR IMPLIED. IN NO EVENT SHALL ANY CONTRIBUTOR OR -COPYRIGHT HOLDER BE LIABLE TO YOU FOR ANY DAMAGES, INCLUDING, BUT NOT -LIMITED TO ANY DIRECT, OR INDIRECT, SPECIAL OR CONSEQUENTIAL DAMAGES ARISING -FROM YOUR USE OR INABILITY TO USE THE SOFTWARE OR THE CONTRIBUTION IN IT, NO -MATTER HOW IT’S CAUSED OR BASED ON WHICH LEGAL THEORY, EVEN IF ADVISED OF -THE POSSIBILITY OF SUCH DAMAGES. - -6. Language - -THIS LICENSE IS WRITTEN IN BOTH CHINESE AND ENGLISH, AND THE CHINESE VERSION -AND ENGLISH VERSION SHALL HAVE THE SAME LEGAL EFFECT. IN THE CASE OF -DIVERGENCE BETWEEN THE CHINESE AND ENGLISH VERSIONS, THE CHINESE VERSION -SHALL PREVAIL. - -END OF THE TERMS AND CONDITIONS - -How to Apply the Mulan Permissive Software License,Version 2 -(Mulan PSL v2) to Your Software - -To apply the Mulan PSL v2 to your work, for easy identification by -recipients, you are suggested to complete following three steps: - -i. Fill in the blanks in following statement, including insert your software -name, the year of the first publication of your software, and your name -identified as the copyright owner; - -ii. Create a file named "LICENSE" which contains the whole context of this -License in the first directory of your software package; - -iii. Attach the statement to the appropriate annotated syntax at the -beginning of each source file. - -Copyright (c) [Year] [name of copyright holder] -[Software Name] is licensed under Mulan PSL v2. -You can use this software according to the terms and conditions of the Mulan -PSL v2. -You may obtain a copy of Mulan PSL v2 at: - http://license.coscl.org.cn/MulanPSL2 -THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY -KIND, EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO -NON-INFRINGEMENT, MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE. -See the Mulan PSL v2 for more details. diff --git a/LiDAR_RTK_Direct_Calibration/.gitignore b/LiDAR_RTK_Direct_Calibration/.gitignore deleted file mode 100644 index f833587..0000000 --- a/LiDAR_RTK_Direct_Calibration/.gitignore +++ /dev/null @@ -1,24 +0,0 @@ -# Python -__pycache__/ -*.py[cod] -.pytest_cache/ -.venv/ -venv/ - -# IDE / OS -.idea/ -.vscode/ -.DS_Store -Thumbs.db - -# Raw data and generated outputs -data/raw/ -work/ -outputs/ -*.rscap -*.dorec -*.log - -# Large generated point clouds outside the archived reference result -**/frames/ -**/frames_all/ diff --git a/LiDAR_RTK_Direct_Calibration/README.md b/LiDAR_RTK_Direct_Calibration/README.md deleted file mode 100644 index 95ff8cf..0000000 --- a/LiDAR_RTK_Direct_Calibration/README.md +++ /dev/null @@ -1,185 +0,0 @@ -# 双天线RTK—3D LiDAR直接手眼标定 - -本仓库从静态站点原始数据复现 `T_RTK_lidar`:把原始雷达坐标转换到RTK导航坐标系。它**不是** `base_link` 车体外参,也不会在求解阶段使用车体航向偏置或RTK到后轮轴的XY杆臂。 - -## 1. 输出坐标约定 - -统一约定 `T_A_B` 把B系点变换到A系: - -```text -p_RTK = T_RTK_lidar · p_lidar -``` - -RTK导航系在本仓库中定义为: - -- 原点:GGA位置参考点(通常为ANT1相位中心,必须结合接收机配置确认); -- X轴:`rawHeading`所表示的双天线基线在水平面的投影; -- Y轴:左; -- Z轴:上; -- ENU航向:`yaw = 90° - rawHeading`; -- roll、pitch:当前轨迹中固定为0。 - -如果下游需要 `T_body_lidar`,必须另有经过确认的 `T_body_rtk`: - -```text -T_body_lidar = T_body_rtk · T_RTK_lidar -``` - -## 2. 算法流程 - -```text -逐站LiDAR dlog + RTK.rscap + IMU.rscap - → 分别解析并保留原始字段 - → 以LiDAR帧时间为索引关联RTK/IMU,生成combined NPZ - → 每站选择一帧静态点云,GGA转局部ENU,rawHeading构造yaw-only RTK pose - → Open3D GICP和small_gicp分别求 B_ij = T_Li_Lj - → 留出点、Hessian、正反向、多初值和旋转共轭不变量筛选 - → 两后端共同认可的边形成consensus B - → A_ij X = X B_ij + 地面法向/高度约束求 X = T_RTK_lidar - → bootstrap、双后端差异、逐对残差和3D可视化检查 -``` - -代码实际使用: - -```text -A_ij = inv(T_W_Ri) · T_W_Rj = T_Ri_Rj -B_ij = T_Li_Lj # 将站点j点云变换到站点i -A_ij · X = X · B_ij -X = T_RTK_lidar -``` - -## 3. 原始数据目录 - -大体积数据不提交Git。`DataRoot`下每个站点必须是一个独立dlog目录,至少包含: - -```text -raw_dataset/ -├── stations/ -│ ├── 001/ -│ │ ├── dobject/ -│ │ └── dobject_recording/ -│ ├── 002/ -│ └── ... -└── captures/ - ├── rtk.rscap - └── imu.rscap -``` - -每个站点应在车辆完全静止后记录点云;建议不少于30站,并包含充足的直行、左转、右转和大角度转向姿态变化。 - -## 4. 环境安装 - -已验证环境为Windows、PowerShell、Python 3.11。安装依赖: - -```powershell -python -m pip install -r requirements.txt -``` - -依赖包括NumPy、SciPy、Open3D和small_gicp。若small_gicp没有对应Windows wheel,可在WSL2中安装后运行Python核心命令,或先只运行Open3D后端;完整共识流程需要两个后端都可用。 - -## 5. 从原始数据一键复现 - -在仓库根目录执行,路径由使用者通过参数传入,脚本内没有本机绝对路径: - -```powershell -$Repo = (Resolve-Path ".").Path -$Raw = "E:\calibration_data\data4" -$Out = "E:\calibration_output\rtk_lidar" - -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_full_pipeline.ps1" ` - -DataRoot "$Raw\stations" ` - -RtkCapture "$Raw\captures\rtk.rscap" ` - -ImuCapture "$Raw\captures\imu.rscap" ` - -OutputRoot $Out ` - -RtkReferenceHeightAboveGroundM 0.8535 ` - -ExpectedStations 34 -``` - -主要输出: - -```text -$Out/ -├── exported/ -│ ├── export/ # 各站LiDAR逐帧NPZ -│ ├── parsed/ # RTK/IMU JSONL -│ └── combined/ # 按LiDAR帧关联后的多传感器NPZ -├── prepared_rtk_direct/ -│ ├── frames_all/ # 每站选中的静态帧 -│ └── reference_poses_rtk_gga_raw_heading.csv -└── calibration/ - ├── open3d_gicp/ - ├── small_gicp/ - ├── consensus/ - ├── summary.json - └── final_T_RTK_lidar.json -``` - -若已经有`combined/`,可跳过原始导出: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_direct_rtk_lidar.ps1" ` - -CombinedRoot "E:\calibration_output\exported\combined" ` - -WorkRoot "E:\calibration_output\prepared_rtk_direct" ` - -OutputRoot "E:\calibration_output\calibration" ` - -RtkReferenceHeightAboveGroundM 0.8535 ` - -ExpectedStations 34 -``` - -## 6. 3D可视化 - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\view_result.ps1" ` - -Frames "$Out\prepared_rtk_direct\frames_all" ` - -Pairs "$Out\calibration\consensus\B_consensus.npz" ` - -Extrinsic "$Out\calibration\final_T_RTK_lidar.json" ` - -PairIndex 0 -``` - -窗口中: - -- 蓝色:目标站点i;橙色:站点j; -- `1`:原始点云; -- `2`:RTK运动A直接作为初值; -- `3`:GICP测得的B; -- `4`:最终外参预测的 `X^-1 A X`; -- `Q/Esc`:退出。 - -模式3和4应让同一墙面、立柱、路缘和地面尽量重合。终端同时打印 `B^-1(X^-1AX)` 的平移和旋转增量。应查看多对,不能只挑视觉效果最好的一对。 - -## 7. data4参考结果 - -仓库保留了精简参考产物,见[`results/reference_data4`](results/reference_data4/README.md): - -```text -translation_m = [1.638179350, -0.240844799, 0.084481236] -RPY_deg_xyz = [-0.817167459, 1.323288119, -22.104163318] - -站点:34 -共识运动对:25 -AX Translation RMS:0.100207 m -AX Rotation RMS:1.252794° -Weighted Jacobian condition:7.739413 -Open3D vs small_gicp:0.003889 m / 0.188431° -``` - -唯一建议下游读取的参考结果是[`final_T_RTK_lidar.json`](results/reference_data4/final_T_RTK_lidar.json)。 - -## 8. z与精度限制 - -平面阿克曼运动不能独立观测z。参考结果使用34站地面平面和RTK参考点离地`0.8535 m`约束z;该高度必须量到实际GGA参考点/天线相位中心。更改参考高度后必须重新求解。 - -AX残差、Hessian/Jacobian条件数、bootstrap和双后端一致性只证明内部一致性,不能单独证明逐帧GT达到±3 cm。当前关联仍以LiDAR和串口主机接收时间为主;GNSS周/周内时间和IMU设备时间被保留,但没有联合估计时钟偏移与漂移。用于连续GT pose前,应补做严格设备时间同步和独立轨迹验证。 - -此外,代码无法单独证明GGA对应哪根物理天线、`rawHeading`是ANT1→ANT2还是ANT2→ANT1;必须用接收机配置、接线和现场运动实验确认。方向错误会导致RTK坐标系yaw相差约180°。 - -## 9. 仓库目录 - -| 目录 | 职责 | -|---|---| -| [`code/`](code/) | GICP、运动对质量评价、AX=XB求解、结果封装和3D可视化 | -| [`tools/`](tools/) | 原始dlog/rscap解析、按LiDAR帧关联及静态站点prepared生成 | -| [`run/`](run/) | PowerShell入口;所有数据和输出路径都通过参数传入 | -| [`results/reference_data4/`](results/reference_data4/) | 可提交Git的精简参考结果,不包含点云和本机过程目录 | -| `work/`、`outputs/` | 本地运行生成物,已由`.gitignore`排除 | - -各代码文件职责见[`code/README.md`](code/README.md),命令索引见[`run/README.md`](run/README.md),工具说明见[`tools/README.md`](tools/README.md)。 diff --git a/LiDAR_RTK_Direct_Calibration/code/compare_extrinsics.py b/LiDAR_RTK_Direct_Calibration/code/compare_extrinsics.py deleted file mode 100644 index b407738..0000000 --- a/LiDAR_RTK_Direct_Calibration/code/compare_extrinsics.py +++ /dev/null @@ -1,43 +0,0 @@ -#!/usr/bin/env python3 -"""Compare two homogeneous-extrinsic JSON files in parameter space and on SE(3).""" - -import argparse -import json -from pathlib import Path - -import numpy as np -from scipy.spatial.transform import Rotation - - -def main() -> int: - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--reference", type=Path, required=True) - parser.add_argument("--candidate", type=Path, required=True) - parser.add_argument("--output", type=Path, required=True) - args = parser.parse_args() - reference = json.loads(args.reference.read_text(encoding="utf-8-sig")) - candidate = json.loads(args.candidate.read_text(encoding="utf-8-sig")) - a = np.asarray(reference["matrix_4x4"], dtype=float) - b = np.asarray(candidate["matrix_4x4"], dtype=float) - delta = np.linalg.inv(a) @ b - result = { - "convention": "delta = inverse(reference) @ candidate", - "reference": str(args.reference.resolve()), - "candidate": str(args.candidate.resolve()), - "candidate_minus_reference_translation_xyz_m": (b[:3, 3] - a[:3, 3]).tolist(), - "candidate_minus_reference_rpy_xyz_deg": ( - np.asarray(candidate["rotation_rpy_deg_xyz"], float) - - np.asarray(reference["rotation_rpy_deg_xyz"], float) - ).tolist(), - "relative_translation_norm_m": float(np.linalg.norm(delta[:3, 3])), - "relative_rotation_deg": float(np.degrees(Rotation.from_matrix(delta[:3, :3]).magnitude())), - "relative_matrix_4x4": delta.tolist(), - } - args.output.parent.mkdir(parents=True, exist_ok=True) - args.output.write_text(json.dumps(result, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps(result, ensure_ascii=False, indent=2)) - return 0 - - -if __name__ == "__main__": - raise SystemExit(main()) diff --git a/LiDAR_RTK_Direct_Calibration/code/cross_backend_filter.py b/LiDAR_RTK_Direct_Calibration/code/cross_backend_filter.py deleted file mode 100644 index 95436ad..0000000 --- a/LiDAR_RTK_Direct_Calibration/code/cross_backend_filter.py +++ /dev/null @@ -1,81 +0,0 @@ -#!/usr/bin/env python3 -"""Keep common A/B edges on which Open3D and small_gicp agree, without using X.""" -import argparse -import json -from pathlib import Path - -import numpy as np -from scipy.spatial.transform import Rotation - - -def key(meta): - return int(meta[0]), int(meta[1]) - - -def main(): - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--open3d-pairs", required=True) - parser.add_argument("--small-pairs", required=True) - parser.add_argument("--output", required=True) - parser.add_argument("--audit") - parser.add_argument("--max-translation", type=float, default=0.05) - parser.add_argument("--max-rotation", type=float, default=0.50) - parser.add_argument("--min-pairs", type=int, default=25) - args = parser.parse_args() - - with np.load(args.open3d_pairs, allow_pickle=False) as source: - open_a = np.asarray(source["A"], float) - open_b = np.asarray(source["B"], float) - open_meta = np.asarray(source["meta"], float) - station_times = np.asarray(source["station_times"]) - rtk_dt = np.asarray(source["rtk_nearest_dt_s"]) - with np.load(args.small_pairs, allow_pickle=False) as source: - small = {key(meta): np.asarray(b, float) - for meta, b in zip(source["meta"], source["B"])} - - keep, audit = [], [] - for meta, b_open in zip(open_meta, open_b): - edge = key(meta) - if edge not in small: - audit.append({"i": edge[0], "j": edge[1], "accepted": False, - "reason": "not_in_small_gicp_refined"}) - keep.append(False) - continue - delta = np.linalg.inv(b_open) @ small[edge] - translation = float(np.linalg.norm(delta[:3, 3])) - rotation = float(np.rad2deg(Rotation.from_matrix(delta[:3, :3]).magnitude())) - accepted = translation <= args.max_translation and rotation <= args.max_rotation - keep.append(accepted) - audit.append({ - "i": edge[0], "j": edge[1], - "open3d_small_translation_m": translation, - "open3d_small_rotation_deg": rotation, - "accepted": accepted, - "reason": "" if accepted else "backend_disagreement", - }) - keep = np.asarray(keep, bool) - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - np.savez_compressed( - output, A=open_a[keep], B=open_b[keep], meta=open_meta[keep], - station_times=station_times, rtk_nearest_dt_s=rtk_dt, - backend=np.asarray("open3d_gicp_cross_backend_consensus"), - ) - audit_path = Path(args.audit or output.with_suffix(".consensus.json")) - audit_path.write_text(json.dumps({ - "selection_is_X_independent": True, - "B_source": "Open3D; small_gicp is used only as an agreement gate", - "max_translation_m": args.max_translation, - "max_rotation_deg": args.max_rotation, - "input_open3d_pairs": len(open_b), - "accepted_pairs": int(np.count_nonzero(keep)), - "pairs": audit, - }, ensure_ascii=False, indent=2), encoding="utf-8") - if np.count_nonzero(keep) < args.min_pairs: - raise RuntimeError(f"only {np.count_nonzero(keep)} consensus pairs") - print(json.dumps({"accepted_pairs": int(np.count_nonzero(keep)), - "output": str(output.resolve()), "audit": str(audit_path.resolve())}, indent=2)) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/code/refine_pairs.py b/LiDAR_RTK_Direct_Calibration/code/refine_pairs.py deleted file mode 100644 index f460d36..0000000 --- a/LiDAR_RTK_Direct_Calibration/code/refine_pairs.py +++ /dev/null @@ -1,87 +0,0 @@ -#!/usr/bin/env python3 -"""X-independent second-stage filter for stationary A/B pairs.""" -import argparse -import json -from pathlib import Path - -import numpy as np - -from rigorous_calibration import read_pairs, rotation_angle_deg - - -def main(): - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--pairs", required=True) - parser.add_argument("--quality-json", required=True) - parser.add_argument("--output", required=True) - parser.add_argument("--audit") - parser.add_argument("--min-pairs", type=int, default=25) - parser.add_argument("--min-inlier-ratio", type=float, default=0.70) - parser.add_argument("--max-inlier-rmse", type=float, default=0.13) - parser.add_argument("--max-rotation-invariant-error", type=float, default=0.75) - parser.add_argument("--reverse-translation-tolerance", type=float, default=0.05) - parser.add_argument("--reverse-rotation-tolerance", type=float, default=0.50) - args = parser.parse_args() - - a_array, b_array, meta, _ = read_pairs(args.pairs) - quality = json.loads(Path(args.quality_json).read_text(encoding="utf-8-sig")) - reports = {(int(item["i"]), int(item["j"])): item for item in quality["pairs"]} - keep, audit = [], [] - for a_ij, b_ij, item_meta in zip(a_array, b_array, meta): - key = (int(item_meta[0]), int(item_meta[1])) - report = reports[key] - heldout = report["heldout_symmetric"] - reverse = report["forward_reverse"] - invariant = abs(rotation_angle_deg(a_ij[:3, :3]) - rotation_angle_deg(b_ij[:3, :3])) - reasons = [] - if heldout["inlier_ratio"] < args.min_inlier_ratio: - reasons.append("overlap_ratio") - if heldout["inlier_rmse_m"] is None or heldout["inlier_rmse_m"] > args.max_inlier_rmse: - reasons.append("heldout_rmse") - if invariant > args.max_rotation_invariant_error: - reasons.append("rotation_conjugacy_invariant") - if reverse["translation_m"] > args.reverse_translation_tolerance: - reasons.append("forward_reverse_translation") - if reverse["rotation_deg"] > args.reverse_rotation_tolerance: - reasons.append("forward_reverse_rotation") - accepted = not reasons - keep.append(accepted) - audit.append({ - "i": key[0], "j": key[1], "heldout_inlier_ratio": heldout["inlier_ratio"], - "heldout_inlier_rmse_m": heldout["inlier_rmse_m"], - "rotation_invariant_error_deg": invariant, - "reverse_translation_m": reverse["translation_m"], - "reverse_rotation_deg": reverse["rotation_deg"], - "accepted": accepted, "rejection_reasons": reasons, - }) - keep = np.asarray(keep, bool) - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - with np.load(args.pairs, allow_pickle=False) as source: - np.savez_compressed( - output, A=a_array[keep], B=b_array[keep], meta=meta[keep], - station_times=np.asarray(source["station_times"]), - rtk_nearest_dt_s=np.asarray(source["rtk_nearest_dt_s"]), - backend=np.asarray(source["backend"]), - ) - audit_path = Path(args.audit or output.with_suffix(".refinement.json")) - audit_path.write_text(json.dumps({ - "selection_is_X_independent": True, - "criteria": { - "min_inlier_ratio": args.min_inlier_ratio, - "max_inlier_rmse_m": args.max_inlier_rmse, - "max_rotation_invariant_error_deg": args.max_rotation_invariant_error, - "reverse_translation_tolerance_m": args.reverse_translation_tolerance, - "reverse_rotation_tolerance_deg": args.reverse_rotation_tolerance, - }, - "input_pairs": len(keep), "accepted_pairs": int(np.count_nonzero(keep)), - "pairs": audit, - }, ensure_ascii=False, indent=2), encoding="utf-8") - if np.count_nonzero(keep) < args.min_pairs: - raise RuntimeError(f"only {np.count_nonzero(keep)} refined pairs; need {args.min_pairs}") - print(json.dumps({"input_pairs": len(keep), "accepted_pairs": int(np.count_nonzero(keep)), - "output": str(output.resolve()), "audit": str(audit_path.resolve())}, indent=2)) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/code/rigorous_calibration.py b/LiDAR_RTK_Direct_Calibration/code/rigorous_calibration.py deleted file mode 100644 index 0974795..0000000 --- a/LiDAR_RTK_Direct_Calibration/code/rigorous_calibration.py +++ /dev/null @@ -1,771 +0,0 @@ -#!/usr/bin/env python3 -"""Rigorous stationary LiDAR / reference-trajectory hand-eye calibration. - -Convention: T_A_B maps points from frame B into frame A. -For this repository the reference frame is the RTK navigation frame. -X = T_RTK_lidar, A_ij = T_W_Ri^-1 T_W_Rj, B_ij = T_Li_Lj, -therefore A_ij X = X B_ij. Raw sensor-frame points_raw are used. -""" -from __future__ import annotations - -import argparse -import csv -import json -import math -import time -from dataclasses import dataclass -from pathlib import Path - -import numpy as np -from scipy.optimize import least_squares -from scipy.spatial import cKDTree - - -def skew(v): - x, y, z = v - return np.array([[0.0, -z, y], [z, 0.0, -x], [-y, x, 0.0]]) - - -def so3_exp(v): - angle = float(np.linalg.norm(v)) - if angle < 1e-12: - return np.eye(3) + skew(v) - k = skew(np.asarray(v, float) / angle) - return np.eye(3) + math.sin(angle) * k + (1.0 - math.cos(angle)) * k @ k - - -def so3_log(rotation): - cosine = float(np.clip((np.trace(rotation) - 1.0) / 2.0, -1.0, 1.0)) - angle = math.acos(cosine) - vee = np.array([ - rotation[2, 1] - rotation[1, 2], - rotation[0, 2] - rotation[2, 0], - rotation[1, 0] - rotation[0, 1], - ]) - if angle < 1e-9: - return vee / 2.0 - if abs(math.pi - angle) < 1e-5: - values, vectors = np.linalg.eigh((rotation + np.eye(3)) / 2.0) - return vectors[:, int(np.argmax(values))] * angle - return vee * angle / (2.0 * math.sin(angle)) - - -def quat_to_rotation(q): - x, y, z, w = np.asarray(q, float) / np.linalg.norm(q) - return np.array([ - [1-2*(y*y+z*z), 2*(x*y-z*w), 2*(x*z+y*w)], - [2*(x*y+z*w), 1-2*(x*x+z*z), 2*(y*z-x*w)], - [2*(x*z-y*w), 2*(y*z+x*w), 1-2*(x*x+y*y)], - ]) - - -def rotation_to_quat(rotation): - from scipy.spatial.transform import Rotation - return Rotation.from_matrix(rotation).as_quat() - - -def rpy_deg(rotation): - from scipy.spatial.transform import Rotation - return Rotation.from_matrix(rotation).as_euler("xyz", degrees=True).tolist() - - -def make_transform(translation, rotation): - transform = np.eye(4) - transform[:3, :3] = rotation - transform[:3, 3] = translation - return transform - - -def params_transform(params): - return make_transform(params[:3], so3_exp(params[3:])) - - -def inverse_transform(transform): - answer = np.eye(4) - answer[:3, :3] = transform[:3, :3].T - answer[:3, 3] = -answer[:3, :3] @ transform[:3, 3] - return answer - - -def transform_points(points, transform): - return points @ transform[:3, :3].T + transform[:3, 3] - - -def rotation_angle_deg(rotation): - return math.degrees(np.linalg.norm(so3_log(rotation))) - - -@dataclass -class PoseSeries: - time: np.ndarray - transforms: np.ndarray - - -def read_poses(path): - timestamps, transforms = [], [] - with Path(path).open(encoding="utf-8-sig", newline="") as stream: - reader = csv.DictReader(stream) - required = ("time", "x", "y", "z", "qx", "qy", "qz", "qw") - missing = [key for key in required if key not in (reader.fieldnames or [])] - if missing: - raise ValueError(f"{path}: missing pose fields {missing}") - for row in reader: - timestamps.append(float(row["time"])) - translation = np.array([float(row[k]) for k in ("x", "y", "z")]) - quaternion = np.array([float(row[k]) for k in ("qx", "qy", "qz", "qw")]) - transforms.append(make_transform(translation, quat_to_rotation(quaternion))) - order = np.argsort(timestamps) - return PoseSeries(np.asarray(timestamps)[order], np.asarray(transforms)[order]) - - -def nearest_pose(series, timestamp): - index = int(np.argmin(np.abs(series.time - timestamp))) - return series.transforms[index], float(abs(series.time[index] - timestamp)) - - -def npz_files(root): - files = sorted(Path(root).rglob("*.npz")) - if not files: - raise FileNotFoundError(f"no NPZ files under {root}") - return files - - -def load_npz_xyz(path, min_range=1.0, max_range=50.0): - with np.load(path, allow_pickle=False) as data: - if "points_raw" not in data: - raise ValueError(f"{path}: points_raw is required; cart-frame points are forbidden") - raw = np.asarray(data["points_raw"], dtype=np.float64) - timestamp = float(np.ravel(data["unix_time_ns"])[0]) / 1e9 - counter = int(np.ravel(data["frame_counter"])[0]) - distance = raw[:, 0] * 0.001 - azimuth = np.deg2rad(raw[:, 1]) - altitude = np.deg2rad(raw[:, 2]) - valid = ( - np.isfinite(distance + azimuth + altitude) - & (distance >= min_range) - & (distance <= max_range) - ) - distance, azimuth, altitude = distance[valid], azimuth[valid], altitude[valid] - xyz = np.column_stack(( - distance * np.cos(altitude) * np.cos(azimuth), - distance * np.cos(altitude) * np.sin(azimuth), - distance * np.sin(altitude), - )) - return timestamp, counter, xyz - - -def load_stations(root, min_range, max_range, z_min=None, z_max=None): - stations = [] - for path in npz_files(root): - timestamp, counter, xyz = load_npz_xyz(path, min_range, max_range) - if z_min is not None: - xyz = xyz[(xyz[:, 2] >= z_min) & (xyz[:, 2] <= z_max)] - stations.append((timestamp, counter, path, xyz)) - stations.sort(key=lambda item: item[0]) - return stations - - -def split_holdout(points, fraction, phase): - stride = max(int(round(1.0 / fraction)), 2) - index = np.arange(len(points)) - holdout = ((index + phase) % stride) == 0 - return points[~holdout], points[holdout] - - -def make_o3d_cloud(points, voxel): - import open3d as o3d - cloud = o3d.geometry.PointCloud() - cloud.points = o3d.utility.Vector3dVector(np.asarray(points, float)) - return cloud.voxel_down_sample(voxel) - - -def align_open3d(target, source, initial, voxels, correspondences, iterations): - import open3d as o3d - registration = o3d.pipelines.registration - estimate = registration.TransformationEstimationForGeneralizedICP() - criteria = registration.ICPConvergenceCriteria(max_iteration=iterations) - transform, stages = np.asarray(initial, float), [] - final_target = final_source = final_answer = None - started = time.perf_counter() - for voxel, correspondence in zip(voxels, correspondences): - target_cloud = make_o3d_cloud(target, voxel) - source_cloud = make_o3d_cloud(source, voxel) - answer = registration.registration_generalized_icp( - source_cloud, target_cloud, correspondence, transform, estimate, criteria - ) - transform = np.asarray(answer.transformation, float) - stages.append({ - "voxel_m": voxel, - "max_correspondence_m": correspondence, - "fitness": float(answer.fitness), - "inlier_rmse_m": float(answer.inlier_rmse), - "target_points": len(target_cloud.points), - "source_points": len(source_cloud.points), - }) - final_target, final_source, final_answer = target_cloud, source_cloud, answer - information = registration.get_information_matrix_from_point_clouds( - final_source, final_target, correspondences[-1], transform - ) - inliers = int(round(float(final_answer.fitness) * len(final_source.points))) - return { - "transform": transform, - "hessian": np.asarray(information, float), - "converged": None, - "iterations": None, - "num_inliers": inliers, - "objective": float(final_answer.inlier_rmse ** 2 * max(inliers, 1)), - "elapsed_sec": time.perf_counter() - started, - "stages": stages, - } - - -def align_small_gicp(target, source, initial, voxels, correspondences, iterations, threads): - import small_gicp - transform, stages, result = np.asarray(initial, float), [], None - started = time.perf_counter() - for voxel, correspondence in zip(voxels, correspondences): - result = small_gicp.align( - np.ascontiguousarray(target), - np.ascontiguousarray(source), - transform, - registration_type="GICP", - downsampling_resolution=voxel, - max_correspondence_distance=correspondence, - num_threads=threads, - max_iterations=iterations, - rotation_epsilon=math.radians(0.005), - translation_epsilon=0.0005, - verbose=False, - ) - transform = np.asarray(result.T_target_source, float) - stages.append({ - "voxel_m": voxel, - "max_correspondence_m": correspondence, - "converged": bool(result.converged), - "iterations": int(result.iterations), - "num_inliers": int(result.num_inliers), - "objective": float(result.error), - }) - return { - "transform": transform, - "hessian": np.asarray(result.H, float), - "converged": bool(result.converged), - "iterations": int(result.iterations), - "num_inliers": int(result.num_inliers), - "objective": float(result.error), - "elapsed_sec": time.perf_counter() - started, - "stages": stages, - } - - -def align_backend(backend, target, source, initial, args): - if backend == "open3d": - return align_open3d( - target, source, initial, args.voxels, args.correspondences, args.iterations - ) - return align_small_gicp( - target, source, initial, args.voxels, args.correspondences, - args.iterations, args.threads - ) - - -def symmetric_heldout_metrics(target_fit, target_holdout, source_fit, source_holdout, - transform, threshold): - transformed_source_fit = transform_points(source_fit, transform) - transformed_source_holdout = transform_points(source_holdout, transform) - forward = cKDTree(target_fit).query(transformed_source_holdout, workers=-1)[0] - reverse = cKDTree(transformed_source_fit).query(target_holdout, workers=-1)[0] - distances = np.concatenate((forward, reverse)) - inliers = distances[distances <= threshold] - return { - "evaluated": int(len(distances)), - "inliers": int(len(inliers)), - "inlier_ratio": float(len(inliers) / max(len(distances), 1)), - "inlier_rmse_m": float(np.sqrt(np.mean(inliers**2))) if len(inliers) else None, - "median_m": float(np.median(distances)), - "p90_m": float(np.quantile(distances, 0.90)), - "p95_m": float(np.quantile(distances, 0.95)), - } - - -def hessian_metrics(hessian, characteristic_length=10.0): - hessian = 0.5 * (np.asarray(hessian, float) + np.asarray(hessian, float).T) - scale = np.diag([1.0 / characteristic_length] * 3 + [1.0] * 3) - scaled = scale.T @ hessian @ scale - values, vectors = np.linalg.eigh(scaled) - largest = max(float(np.max(np.abs(values))), np.finfo(float).eps) - positive = values[values > largest * 1e-9] - condition = float(positive[-1] / positive[0]) if len(positive) else float("inf") - return { - "native_order": ["rx_rad", "ry_rad", "rz_rad", "tx_m", "ty_m", "tz_m"], - "scaled_eigenvalues": values.tolist(), - "effective_rank": int(len(positive)), - "scaled_condition_number": condition, - "weakest_scaled_direction": vectors[:, int(np.argmin(values))].tolist(), - } - - -def transform_difference(reference, candidate): - delta = inverse_transform(reference) @ candidate - return { - "translation_m": float(np.linalg.norm(delta[:3, 3])), - "rotation_deg": rotation_angle_deg(delta[:3, :3]), - } - - -def loop_metrics(transforms): - loops = [] - for (i, j), b_ij in transforms.items(): - for (j2, k), b_jk in transforms.items(): - if j2 != j or (i, k) not in transforms: - continue - loops.append(transform_difference(transforms[(i, k)], b_ij @ b_jk)) - if not loops: - return {"count": 0} - translation = np.array([item["translation_m"] for item in loops]) - rotation = np.array([item["rotation_deg"] for item in loops]) - return { - "count": len(loops), - "translation_rms_m": float(np.sqrt(np.mean(translation**2))), - "translation_p95_m": float(np.quantile(translation, 0.95)), - "rotation_rms_deg": float(np.sqrt(np.mean(rotation**2))), - "rotation_p95_deg": float(np.quantile(rotation, 0.95)), - } - - -def cmd_ground(args): - stations = load_stations(args.frames, args.min_range, args.max_range) - rows = [] - for timestamp, counter, _, xyz in stations: - roi = xyz[(xyz[:, 2] >= args.z_min) & (xyz[:, 2] <= args.z_max)] - if len(roi) < args.min_inliers: - continue - cloud = make_o3d_cloud(roi, args.voxel) - plane, indexes = cloud.segment_plane( - args.distance_threshold, 3, args.ransac_iterations - ) - normal = np.asarray(plane[:3], float) - norm = np.linalg.norm(normal) - normal, distance = normal / norm, float(plane[3] / norm) - if distance < 0: - normal, distance = -normal, -distance - points = np.asarray(cloud.points)[indexes] - rms = float(np.sqrt(np.mean((points @ normal + distance) ** 2))) - if len(indexes) >= args.min_inliers and rms <= args.max_rms: - rows.append([timestamp, *normal, distance, len(indexes), rms, counter]) - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - with output.open("w", encoding="utf-8", newline="") as stream: - writer = csv.writer(stream) - writer.writerow(["time", "nx", "ny", "nz", "d", "inliers", "rms_m", "frame_counter"]) - writer.writerows(rows) - print(json.dumps({"planes": len(rows), "output": str(output.resolve())}, indent=2)) - - -def cmd_pairs(args): - if len(args.voxels) != len(args.correspondences): - raise ValueError("--voxels and --correspondences must have equal lengths") - stations = load_stations( - args.frames, args.min_range, args.max_range, args.z_min, args.z_max - ) - reference = read_poses(args.reference_poses) - if len(stations) < args.min_stations: - raise ValueError(f"need at least {args.min_stations} stations, got {len(stations)}") - reference_poses, reference_dt = [], [] - for timestamp, _, _, xyz in stations: - if len(xyz) < args.min_roi_points: - raise ValueError(f"station at {timestamp} has only {len(xyz)} ROI points") - pose, dt = nearest_pose(reference, timestamp + args.time_offset) - reference_poses.append(pose) - reference_dt.append(dt) - reference_poses = np.asarray(reference_poses) - split = [split_holdout(station[3], args.holdout_fraction, i) - for i, station in enumerate(stations)] - rng = np.random.default_rng(args.seed) - accepted_a, accepted_b, accepted_meta, reports = [], [], [], [] - accepted_transforms = {} - for i in range(len(stations)): - for j in range(i + args.min_gap, min(len(stations), i + args.max_gap + 1)): - a_ij = inverse_transform(reference_poses[i]) @ reference_poses[j] - translation = float(np.linalg.norm(a_ij[:2, 3])) - rotation = rotation_angle_deg(a_ij[:3, :3]) - if translation < args.min_translation and rotation < args.min_rotation: - continue - initial_b = a_ij.copy() # X0=I; no measured extrinsic. - target_fit, target_holdout = split[i] - source_fit, source_holdout = split[j] - forward = align_backend(args.backend, target_fit, source_fit, initial_b, args) - heldout = symmetric_heldout_metrics( - target_fit, target_holdout, source_fit, source_holdout, - forward["transform"], args.evaluation_distance - ) - hessian = hessian_metrics(forward["hessian"]) - reverse_answer = align_backend( - args.backend, source_fit, target_fit, inverse_transform(initial_b), args - ) - reverse = transform_difference( - forward["transform"], inverse_transform(reverse_answer["transform"]) - ) - multistart = [] - for _ in range(args.multistart): - perturb = np.r_[ - rng.normal(0.0, args.multistart_translation_sigma, 3), - np.deg2rad(rng.normal(0.0, args.multistart_rotation_sigma, 3)), - ] - candidate = align_backend( - args.backend, target_fit, source_fit, - params_transform(perturb) @ initial_b, args - ) - multistart.append(transform_difference(forward["transform"], candidate["transform"])) - stable = [ - item["translation_m"] <= args.multistart_translation_tolerance - and item["rotation_deg"] <= args.multistart_rotation_tolerance - for item in multistart - ] - success_rate = float(np.mean(stable)) if stable else 1.0 - reasons = [] - if forward["converged"] is False: - reasons.append("backend_not_converged") - if heldout["inlier_ratio"] < args.min_inlier_ratio: - reasons.append("heldout_inlier_ratio") - if heldout["inlier_rmse_m"] is None or heldout["inlier_rmse_m"] > args.max_inlier_rmse: - reasons.append("heldout_inlier_rmse") - if hessian["effective_rank"] < 6: - reasons.append("hessian_rank") - if hessian["scaled_condition_number"] > args.max_hessian_condition: - reasons.append("hessian_condition") - if reverse["translation_m"] > args.reverse_translation_tolerance: - reasons.append("forward_reverse_translation") - if reverse["rotation_deg"] > args.reverse_rotation_tolerance: - reasons.append("forward_reverse_rotation") - if success_rate < args.min_multistart_success: - reasons.append("multistart_instability") - accepted = not reasons - report = { - "i": i, "j": j, - "lidar_time_i": stations[i][0], "lidar_time_j": stations[j][0], - "frame_counter_i": stations[i][1], "frame_counter_j": stations[j][1], - "rtk_translation_m": translation, "rtk_rotation_deg": rotation, - "nearest_rtk_dt_i_s": reference_dt[i], "nearest_rtk_dt_j_s": reference_dt[j], - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": forward["transform"].tolist(), - "backend": args.backend, "backend_converged": forward["converged"], - "backend_iterations": forward["iterations"], - "backend_num_inliers": forward["num_inliers"], - "backend_objective": forward["objective"], - "backend_elapsed_sec": forward["elapsed_sec"], - "multiscale_stages": forward["stages"], - "heldout_symmetric": heldout, "hessian": hessian, - "forward_reverse": reverse, - "multistart": {"runs": len(multistart), "success_rate": success_rate, - "deltas": multistart}, - "accepted": accepted, "rejection_reasons": reasons, - } - reports.append(report) - print(f"{args.backend} {i:02d}->{j:02d} rmse={heldout['inlier_rmse_m']} " - f"ratio={heldout['inlier_ratio']:.3f} accepted={accepted}") - if accepted: - accepted_a.append(a_ij) - accepted_b.append(forward["transform"]) - accepted_meta.append([i, j, stations[i][0], stations[j][0]]) - accepted_transforms[(i, j)] = forward["transform"] - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - np.savez_compressed( - output, A=np.asarray(accepted_a), B=np.asarray(accepted_b), - meta=np.asarray(accepted_meta), - station_times=np.asarray([item[0] for item in stations]), - rtk_nearest_dt_s=np.asarray(reference_dt), backend=np.asarray(args.backend), - ) - quality = { - "schema_version": 2, - "backend": args.backend, - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": False, - "stations": len(stations), "candidate_pairs": len(reports), - "accepted_pairs": len(accepted_a), - "parameters": vars(args), - "accepted_loop_closure": loop_metrics(accepted_transforms), - "pairs": reports, - } - quality["parameters"].pop("func", None) - quality_path = Path(args.quality_json or output.with_suffix(".quality.json")) - quality_path.write_text(json.dumps(quality, ensure_ascii=False, indent=2), encoding="utf-8") - csv_path = Path(args.quality_csv or output.with_suffix(".quality.csv")) - with csv_path.open("w", encoding="utf-8", newline="") as stream: - fields = ["i", "j", "rtk_translation_m", "rtk_rotation_deg", - "heldout_inlier_ratio", "heldout_inlier_rmse_m", - "hessian_rank", "hessian_condition", "reverse_translation_m", - "reverse_rotation_deg", "multistart_success_rate", "accepted", - "rejection_reasons"] - writer = csv.DictWriter(stream, fieldnames=fields) - writer.writeheader() - for item in reports: - writer.writerow({ - "i": item["i"], "j": item["j"], - "rtk_translation_m": item["rtk_translation_m"], - "rtk_rotation_deg": item["rtk_rotation_deg"], - "heldout_inlier_ratio": item["heldout_symmetric"]["inlier_ratio"], - "heldout_inlier_rmse_m": item["heldout_symmetric"]["inlier_rmse_m"], - "hessian_rank": item["hessian"]["effective_rank"], - "hessian_condition": item["hessian"]["scaled_condition_number"], - "reverse_translation_m": item["forward_reverse"]["translation_m"], - "reverse_rotation_deg": item["forward_reverse"]["rotation_deg"], - "multistart_success_rate": item["multistart"]["success_rate"], - "accepted": item["accepted"], - "rejection_reasons": ";".join(item["rejection_reasons"]), - }) - if len(accepted_a) < args.min_pairs: - raise RuntimeError(f"only {len(accepted_a)} accepted pairs; need {args.min_pairs}") - print(json.dumps({ - "backend": args.backend, "stations": len(stations), - "candidate_pairs": len(reports), "accepted_pairs": len(accepted_a), - "output": str(output.resolve()), "quality_json": str(quality_path.resolve()), - "loop": quality["accepted_loop_closure"], - }, indent=2)) - - -def read_planes(path): - planes = [] - with Path(path).open(encoding="utf-8-sig", newline="") as stream: - for row in csv.DictReader(stream): - normal = np.array([float(row[k]) for k in ("nx", "ny", "nz")]) - norm = np.linalg.norm(normal) - normal, distance = normal / norm, float(row["d"]) / norm - if distance < 0: - normal, distance = -normal, -distance - planes.append([*normal, distance]) - return np.asarray(planes) - - -def read_pairs(path): - with np.load(path, allow_pickle=False) as data: - return (np.asarray(data["A"], float), np.asarray(data["B"], float), - np.asarray(data["meta"], float), len(data["station_times"])) - - -def calibration_residual(params, a_array, b_array, planes, args): - x = params_transform(params) - values = [] - for a_ij, b_ij in zip(a_array, b_array): - error = inverse_transform(a_ij @ x) @ x @ b_ij - values.extend((error[:3, 3] / args.translation_sigma).tolist()) - values.extend((so3_log(error[:3, :3]) / math.radians(args.rotation_sigma)).tolist()) - body_up = np.array([0.0, 0.0, 1.0]) - for plane in planes: - normal_body = x[:3, :3] @ plane[:3] - values.extend((np.cross(normal_body, body_up) / args.plane_normal_sigma).tolist()) - body_distance = plane[3] - float(normal_body @ x[:3, 3]) - values.append((body_distance - args.reference_height) / args.plane_height_sigma) - return np.asarray(values) - - -def pair_metrics(a_array, b_array, x): - translation, rotation, rows = [], [], [] - for index, (a_ij, b_ij) in enumerate(zip(a_array, b_array)): - predicted = inverse_transform(x) @ a_ij @ x - delta = inverse_transform(b_ij) @ predicted - t = float(np.linalg.norm(delta[:3, 3])) - r = rotation_angle_deg(delta[:3, :3]) - translation.append(t); rotation.append(r) - rows.append({"pair_index": index, "translation_m": t, "rotation_deg": r}) - translation, rotation = np.asarray(translation), np.asarray(rotation) - def stats(values): - return { - "rms": float(np.sqrt(np.mean(values**2))), - "median": float(np.median(values)), - "p90": float(np.quantile(values, 0.90)), - "p95": float(np.quantile(values, 0.95)), - "max": float(np.max(values)), - } - return {"pairs": len(rows), "translation_m": stats(translation), - "rotation_deg": stats(rotation), "per_pair": rows} - - -def solve_extrinsic(a_array, b_array, planes, args): - rng = np.random.default_rng(args.seed) - starts = [np.zeros(6)] - for _ in range(args.solver_multistart - 1): - starts.append(np.r_[ - rng.normal(0.0, args.start_translation_sigma, 3), - np.deg2rad(rng.normal(0.0, args.start_rotation_sigma, 3)), - ]) - candidates = [] - lower = np.r_[[-5.0] * 3, [-math.pi] * 3] - upper = np.r_[[5.0] * 3, [math.pi] * 3] - for start in starts: - answer = least_squares( - calibration_residual, np.clip(start, lower, upper), - args=(a_array, b_array, planes, args), - bounds=(lower, upper), loss="huber", f_scale=1.5, - x_scale="jac", max_nfev=args.max_nfev, - ) - candidates.append(answer) - best = min(candidates, key=lambda item: item.cost) - return best, candidates - - -def cmd_calibrate(args): - a_array, b_array, meta, stations = read_pairs(args.pairs) - planes = read_planes(args.ground_planes) - best, candidates = solve_extrinsic(a_array, b_array, planes, args) - x = params_transform(best.x) - residual = calibration_residual(best.x, a_array, b_array, planes, args) - absolute = np.abs(residual) - weights = np.ones_like(residual) - weights[absolute > 1.5] = 1.5 / absolute[absolute > 1.5] - weighted_jacobian = best.jac * np.sqrt(weights)[:, None] - singular = np.linalg.svd(weighted_jacobian, compute_uv=False) - condition = float(singular[0] / max(singular[-1], 1e-15)) - dof = max(len(residual) - 6, 1) - covariance = np.linalg.pinv(weighted_jacobian.T @ weighted_jacobian) * float( - np.sum(weights * residual**2) / dof - ) - sigma = np.sqrt(np.maximum(np.diag(covariance), 0.0)) - candidate_summary = [] - for item in candidates: - candidate_x = params_transform(item.x) - candidate_summary.append({ - "cost": float(item.cost), "success": bool(item.success), - **transform_difference(x, candidate_x), - }) - bootstrap = [] - rng = np.random.default_rng(args.seed + 1) - for _ in range(args.bootstrap): - indexes = rng.integers(0, len(a_array), len(a_array)) - answer = least_squares( - calibration_residual, best.x, - args=(a_array[indexes], b_array[indexes], planes, args), - loss="huber", f_scale=1.5, x_scale="jac", max_nfev=args.max_nfev, - ) - bootstrap.append(np.r_[answer.x[:3], rpy_deg(so3_exp(answer.x[3:]))]) - bootstrap = np.asarray(bootstrap) - result = { - "schema_version": 2, - "success": bool(best.success), - "message": best.message, - "convention": "T_reference_lidar maps raw LiDAR points into the supplied reference frame", - "equation": "A_ij X = X B_ij", - "measured_extrinsic_used_as_initial": False, - "translation_m": x[:3, 3].tolist(), - "rotation_rpy_deg_xyz": rpy_deg(x[:3, :3]), - "quaternion_xyzw": rotation_to_quat(x[:3, :3]).tolist(), - "matrix_4x4": x.tolist(), - "estimation": {"stations": stations, "pairs": len(a_array), - "residuals": pair_metrics(a_array, b_array, x)}, - "ground": { - "planes": len(planes), - "reference_origin_height_above_ground_m": args.reference_height, - "formula": "d_lidar - (R_X n_lidar)^T t_X - reference_height", - }, - "linearized_one_sigma": { - "translation_m": sigma[:3].tolist(), - "rotation_deg": np.rad2deg(sigma[3:]).tolist(), - "warning": "conditional local estimate; bootstrap is the primary stability check", - }, - "weighted_jacobian_condition_number": condition, - "solver_multistart": { - "runs": len(candidates), "candidates_relative_to_best": candidate_summary, - }, - "bootstrap": { - "runs": len(bootstrap), - "order": ["x_m", "y_m", "z_m", "roll_deg", "pitch_deg", "yaw_deg"], - "std": np.std(bootstrap, axis=0, ddof=1).tolist() if len(bootstrap) > 1 else None, - "p025": np.quantile(bootstrap, 0.025, axis=0).tolist() if len(bootstrap) else None, - "p975": np.quantile(bootstrap, 0.975, axis=0).tolist() if len(bootstrap) else None, - }, - } - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - output.write_text(json.dumps(result, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps(result, ensure_ascii=False, indent=2)) - - -def cmd_validate(args): - result = json.loads(Path(args.extrinsic).read_text(encoding="utf-8-sig")) - x = np.asarray(result["matrix_4x4"], float) - a_array, b_array, meta, stations = read_pairs(args.pairs) - metrics = pair_metrics(a_array, b_array, x) - for row, pair_meta in zip(metrics["per_pair"], meta): - row.update({"i": int(pair_meta[0]), "j": int(pair_meta[1])}) - report = { - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": True, - "note": "No AX residual was used to select these pairs", - "stations": stations, "metrics": metrics, - } - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - output.write_text(json.dumps(report, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps(report, ensure_ascii=False, indent=2)) - - -def build_parser(): - parser = argparse.ArgumentParser(description=__doc__) - commands = parser.add_subparsers(dest="command", required=True) - ground = commands.add_parser("ground") - ground.add_argument("--frames", required=True); ground.add_argument("--output", required=True) - ground.add_argument("--min-range", type=float, default=1.0); ground.add_argument("--max-range", type=float, default=30.0) - ground.add_argument("--z-min", type=float, default=-1.4); ground.add_argument("--z-max", type=float, default=-0.4) - ground.add_argument("--voxel", type=float, default=0.08); ground.add_argument("--distance-threshold", type=float, default=0.025) - ground.add_argument("--ransac-iterations", type=int, default=500); ground.add_argument("--min-inliers", type=int, default=500) - ground.add_argument("--max-rms", type=float, default=0.025); ground.set_defaults(func=cmd_ground) - - pairs = commands.add_parser("pairs") - pairs.add_argument("--backend", choices=["open3d", "small_gicp"], required=True) - pairs.add_argument("--frames", required=True) - pairs.add_argument("--reference-poses", "--body", dest="reference_poses", required=True) - pairs.add_argument("--output", required=True); pairs.add_argument("--quality-json"); pairs.add_argument("--quality-csv") - pairs.add_argument("--time-offset", type=float, default=0.0) - pairs.add_argument("--min-stations", type=int, default=30); pairs.add_argument("--min-pairs", type=int, default=25) - pairs.add_argument("--min-gap", type=int, default=1); pairs.add_argument("--max-gap", type=int, default=5) - pairs.add_argument("--min-translation", type=float, default=0.5); pairs.add_argument("--min-rotation", type=float, default=3.0) - pairs.add_argument("--min-range", type=float, default=2.0); pairs.add_argument("--max-range", type=float, default=50.0) - pairs.add_argument("--z-min", type=float, default=-0.60); pairs.add_argument("--z-max", type=float, default=5.0) - pairs.add_argument("--min-roi-points", type=int, default=1000) - pairs.add_argument("--holdout-fraction", type=float, default=0.20) - pairs.add_argument("--voxels", nargs="+", type=float, default=[0.30, 0.15, 0.08]) - pairs.add_argument("--correspondences", nargs="+", type=float, default=[1.20, 0.50, 0.25]) - pairs.add_argument("--iterations", type=int, default=60); pairs.add_argument("--threads", type=int, default=8) - pairs.add_argument("--evaluation-distance", type=float, default=0.25) - pairs.add_argument("--min-inlier-ratio", type=float, default=0.35); pairs.add_argument("--max-inlier-rmse", type=float, default=0.16) - pairs.add_argument("--max-hessian-condition", type=float, default=1e8) - pairs.add_argument("--reverse-translation-tolerance", type=float, default=0.08) - pairs.add_argument("--reverse-rotation-tolerance", type=float, default=0.50) - pairs.add_argument("--multistart", type=int, default=2) - pairs.add_argument("--multistart-translation-sigma", type=float, default=0.30) - pairs.add_argument("--multistart-rotation-sigma", type=float, default=3.0) - pairs.add_argument("--multistart-translation-tolerance", type=float, default=0.08) - pairs.add_argument("--multistart-rotation-tolerance", type=float, default=0.50) - pairs.add_argument("--min-multistart-success", type=float, default=0.50) - pairs.add_argument("--seed", type=int, default=20260721); pairs.set_defaults(func=cmd_pairs) - - calibrate = commands.add_parser("calibrate") - calibrate.add_argument("--pairs", required=True); calibrate.add_argument("--ground-planes", required=True) - calibrate.add_argument("--output", required=True) - calibrate.add_argument("--translation-sigma", type=float, default=0.05) - calibrate.add_argument("--rotation-sigma", type=float, default=0.5) - calibrate.add_argument("--plane-normal-sigma", type=float, default=0.02) - calibrate.add_argument("--plane-height-sigma", type=float, default=0.03) - calibrate.add_argument("--reference-height", "--body-height", dest="reference_height", type=float, default=0.8535) - calibrate.add_argument("--solver-multistart", type=int, default=12) - calibrate.add_argument("--start-translation-sigma", type=float, default=1.0) - calibrate.add_argument("--start-rotation-sigma", type=float, default=20.0) - calibrate.add_argument("--bootstrap", type=int, default=100) - calibrate.add_argument("--max-nfev", type=int, default=1000) - calibrate.add_argument("--seed", type=int, default=20260721); calibrate.set_defaults(func=cmd_calibrate) - - validate = commands.add_parser("validate") - validate.add_argument("--pairs", required=True); validate.add_argument("--extrinsic", required=True) - validate.add_argument("--output", required=True); validate.set_defaults(func=cmd_validate) - return parser - - -def main(): - args = build_parser().parse_args() - args.func(args) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/code/visualize_pair_3d.py b/LiDAR_RTK_Direct_Calibration/code/visualize_pair_3d.py deleted file mode 100644 index 3aa71a0..0000000 --- a/LiDAR_RTK_Direct_Calibration/code/visualize_pair_3d.py +++ /dev/null @@ -1,169 +0,0 @@ -#!/usr/bin/env python3 -"""Interactive 3D comparison of raw, RTK, GICP and hand-eye-predicted motion.""" -import argparse -import json - -import numpy as np -from scipy.spatial.transform import Rotation - -from rigorous_calibration import ( - inverse_transform, load_stations, rotation_angle_deg, rpy_deg, transform_points, -) - - -COLORS = { - "target": [0.10, 0.65, 1.00], - "source": [1.00, 0.35, 0.05], -} - - -def cloud(o3d, points, color, voxel): - item = o3d.geometry.PointCloud() - item.points = o3d.utility.Vector3dVector(points) - item = item.voxel_down_sample(voxel) - item.paint_uniform_color(color) - return item - - -def delta_components(reference, candidate): - """Components of reference^-1*candidate, plus coordinate-invariant norms.""" - delta = inverse_transform(reference) @ candidate - translation = np.asarray(delta[:3, 3], float) - return { - "translation_xyz_cm": (translation * 100.0).tolist(), - "translation_norm_cm": float(np.linalg.norm(translation) * 100.0), - "rotation_rpy_deg_xyz": rpy_deg(delta[:3, :3]), - "rotation_angle_deg": rotation_angle_deg(delta[:3, :3]), - } - - -def body_left_rpy(x, rpy_correction_deg): - correction = np.eye(4) - correction[:3, :3] = Rotation.from_euler( - "xyz", np.asarray(rpy_correction_deg, float), degrees=True - ).as_matrix() - return correction @ x - - -def print_delta(name, reference, candidate): - item = delta_components(reference, candidate) - tx, ty, tz = item["translation_xyz_cm"] - roll, pitch, yaw = item["rotation_rpy_deg_xyz"] - print( - f"{name}: B^-1*motion translation xyz = " - f"[{tx:+.4f}, {ty:+.4f}, {tz:+.4f}] cm; " - f"rpy xyz = [{roll:+.4f}, {pitch:+.4f}, {yaw:+.4f}] deg; " - f"norm = {item['translation_norm_cm']:.4f} cm / " - f"{item['rotation_angle_deg']:.6f} deg" - ) - return item - - -def main(): - import open3d as o3d - - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--frames", required=True) - parser.add_argument("--pairs", required=True) - parser.add_argument("--extrinsic", required=True) - parser.add_argument("--pair-index", type=int, default=0) - parser.add_argument("--voxel", type=float, default=0.10) - parser.add_argument( - "--left-rpy-deg", nargs=3, type=float, default=[0.0, 0.0, 0.0], - metavar=("ROLL", "PITCH", "YAW"), - help="optional body-frame left correction applied as DeltaR_body * X", - ) - args = parser.parse_args() - - stations = load_stations(args.frames, 1.0, 60.0) - with np.load(args.pairs, allow_pickle=False) as data: - if len(stations) != len(data["station_times"]): - raise ValueError( - f"frames contain {len(stations)} stations but pair file records " - f"{len(data['station_times'])}" - ) - if not 0 <= args.pair_index < len(data["A"]): - raise IndexError( - f"pair-index {args.pair_index} outside [0,{len(data['A']) - 1}]" - ) - a_ij = np.asarray(data["A"][args.pair_index], float) - b_gicp = np.asarray(data["B"][args.pair_index], float) - i, j = np.asarray(data["meta"][args.pair_index, :2], int) - - with open(args.extrinsic, encoding="utf-8-sig") as stream: - result = json.load(stream) - x = np.asarray(result["matrix_4x4"], float) - b_calibrated = inverse_transform(x) @ a_ij @ x - - transforms = { - "1 raw": np.eye(4), - "2 RTK initial (X0=I)": a_ij, - "3 GICP B": b_gicp, - "4 calibrated X^-1 A X": b_calibrated, - } - correction = np.asarray(args.left_rpy_deg, float) - if np.any(np.abs(correction) > 0.0): - x_test = body_left_rpy(x, correction) - transforms[ - f"5 test body-left RPY {correction.tolist()} deg" - ] = inverse_transform(x_test) @ a_ij @ x_test - - target = stations[i][3] - source = stations[j][3] - print(f"pair_index={args.pair_index}, station {i} <- {j}") - print("blue = target station i; orange = source station j after selected transform") - print("keys: 1 raw | 2 RTK initial | 3 GICP | 4 calibrated | 5 test correction | Q/Esc exit") - print( - "IMPORTANT: delta xyz/rpy are components of B^-1*(X^-1*A*X), expressed " - "in station-j LiDAR coordinates; screen-left/right depends on the 3D camera view." - ) - baseline = print_delta("mode 4 minus mode 3", b_gicp, b_calibrated) - roll, pitch, yaw = np.abs(baseline["rotation_rpy_deg_xyz"]) - if max(roll, pitch) > max(0.10, 2.0 * yaw): - print("diagnosis: roll/pitch components dominate yaw; do not prioritize yaw tuning for this pair.") - tx, ty, tz = np.abs(baseline["translation_xyz_cm"]) - if tz > max(tx, ty): - print("diagnosis: the largest translation component is relative Z, not lateral XY.") - body_up = np.array([0.0, 0.0, 1.0]) - if np.linalg.norm(a_ij[:3, :3] @ body_up - body_up) < 1e-8: - print( - "observability: this A preserves the body Z axis, so body-left X.z " - "translation is unobservable from this pair; use ground/external height constraints." - ) - if "5 test body-left RPY " + str(correction.tolist()) + " deg" in transforms: - print_delta("mode 5 minus mode 3", b_gicp, list(transforms.values())[-1]) - - viewer = o3d.visualization.VisualizerWithKeyCallback() - viewer.create_window("Rigorous LiDAR registration inspection - 3D", 1400, 900) - target_cloud = cloud(o3d, target, COLORS["target"], args.voxel) - source_cloud = cloud(o3d, source, COLORS["source"], args.voxel) - viewer.add_geometry(target_cloud) - viewer.add_geometry(source_cloud) - axes = o3d.geometry.TriangleMesh.create_coordinate_frame(size=1.0) - viewer.add_geometry(axes) - current = np.eye(4) - - def select(name): - def callback(vis): - nonlocal current - desired = transforms[name] - source_cloud.transform(desired @ inverse_transform(current)) - current = desired - vis.update_geometry(source_cloud) - if name == "3 GICP B": - print(f"{name}: reference registration B; delta = 0") - else: - print_delta(name + " minus mode 3", b_gicp, desired) - return False - return callback - - for key, name in zip((ord("1"), ord("2"), ord("3"), ord("4"), ord("5")), transforms): - viewer.register_key_callback(key, select(name)) - viewer.get_render_option().background_color = np.array([0.02, 0.02, 0.02]) - viewer.get_render_option().point_size = 2.0 - viewer.run() - viewer.destroy_window() - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/requirements.txt b/LiDAR_RTK_Direct_Calibration/requirements.txt deleted file mode 100644 index 9f8e5e8..0000000 --- a/LiDAR_RTK_Direct_Calibration/requirements.txt +++ /dev/null @@ -1,4 +0,0 @@ -numpy>=1.26 -scipy>=1.11 -open3d>=0.18 -small-gicp diff --git a/LiDAR_RTK_Direct_Calibration/results/README.md b/LiDAR_RTK_Direct_Calibration/results/README.md deleted file mode 100644 index e43ace6..0000000 --- a/LiDAR_RTK_Direct_Calibration/results/README.md +++ /dev/null @@ -1,5 +0,0 @@ -# results目录 - -`reference_data4/`是本仓库附带的精简参考结果。新的运行结果应写到仓库外目录或`outputs/`,不要覆盖参考结果。 - -参考结果保留最终矩阵、共识B、两后端精筛B、逐对CSV/筛选审计和地面平面;未保留原始点云、逐帧combined数据、冗长的初筛JSON和带本机绝对路径的过程文件。 diff --git a/LiDAR_RTK_Direct_Calibration/run/README.md b/LiDAR_RTK_Direct_Calibration/run/README.md deleted file mode 100644 index 120bf1c..0000000 --- a/LiDAR_RTK_Direct_Calibration/run/README.md +++ /dev/null @@ -1,14 +0,0 @@ -# run目录 - -根README包含完整复现命令;这里仅列入口职责。 - -| 脚本 | 用途 | -|---|---| -| `run_full_pipeline.ps1` | 从逐站LiDAR dlog、RTK rscap、IMU rscap一直运行到最终`T_RTK_lidar` | -| `export_multisensor_stations.ps1` | 解析原始三传感器数据并按LiDAR帧生成combined NPZ | -| `prepare_multisensor_dataset.ps1` | 每站选一帧,生成yaw-only RTK参考轨迹和`frames_all` | -| `run_direct_rtk_lidar.ps1` | 从combined数据运行RTK直接标定和最终结果封装 | -| `run_single_dataset.ps1` | 执行地面、两个GICP后端、精筛、共识和AX=XB求解 | -| `view_result.ps1` | 打开3D运动对对比并打印数值增量 | - -所有路径均为命令行参数;默认生成目录`work/`和`outputs/`不会提交Git。 diff --git a/LiDAR_RTK_Direct_Calibration/run/export_multisensor_stations.ps1 b/LiDAR_RTK_Direct_Calibration/run/export_multisensor_stations.ps1 deleted file mode 100644 index e96be10..0000000 --- a/LiDAR_RTK_Direct_Calibration/run/export_multisensor_stations.ps1 +++ /dev/null @@ -1,89 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$DataRoot, - [Parameter(Mandatory = $true)][string]$OutputRoot, - [Parameter(Mandatory = $true)][string]$RtkCapture, - [Parameter(Mandatory = $true)][string]$ImuCapture, - [string]$LidarObject = "frontlidar", - [string]$Timezone = "+08:00", - [string[]]$StationNames = @(), - [int]$Stride = 1, - [double]$RtkMaxDtMs = 150.0, - [double]$ImuBeforeMs = 100.0, - [double]$ImuAfterMs = 100.0, - [switch]$SkipLidarExport, - [switch]$SkipSerialParsing -) - -$ErrorActionPreference = "Stop" -$RepoRoot = Split-Path -Parent $PSScriptRoot -$Exporter = Join-Path $RepoRoot "tools\frontlidar_dlog_export.py" -$Builder = Join-Path $RepoRoot "tools\build_multisensor_npz.py" -$Parser = Join-Path $RepoRoot "tools\rscap_v2\parse_rtk_imu_v2.py" -$Auditor = Join-Path $RepoRoot "tools\rscap_v2\audit_capture_v2.py" -$ExportRoot = Join-Path $OutputRoot "export" -$ParsedRoot = Join-Path $OutputRoot "parsed" -$CombinedRoot = Join-Path $OutputRoot "combined" - -function Run-Python { - param([string]$Stage, [string[]]$Arguments) - Write-Host "[$Stage]" - & python @Arguments - if ($LASTEXITCODE -ne 0) { - throw "$Stage failed with Python exit code $LASTEXITCODE" - } -} - -foreach ($Path in @($DataRoot, $RtkCapture, $ImuCapture)) { - if (-not (Test-Path -LiteralPath $Path)) { throw "Input does not exist: $Path" } -} -if ($Stride -lt 1) { throw "Stride must be at least 1" } - -if ($StationNames.Count -gt 0) { - $Stations = @($StationNames | ForEach-Object { Get-Item -LiteralPath (Join-Path $DataRoot $_) }) -} else { - $Stations = @(Get-ChildItem -LiteralPath $DataRoot -Directory | Where-Object { - (Test-Path -LiteralPath (Join-Path $_.FullName "dobject")) -and - (Test-Path -LiteralPath (Join-Path $_.FullName "dobject_recording")) - } | Sort-Object Name) -} -if ($Stations.Count -eq 0) { throw "No station directory containing dobject and dobject_recording was found" } - -New-Item -ItemType Directory -Force -Path $OutputRoot | Out-Null -if (-not $SkipSerialParsing) { - New-Item -ItemType Directory -Force -Path $ParsedRoot | Out-Null - Run-Python "capture audit" @($Auditor, $RtkCapture, $ImuCapture, "--out", (Join-Path $OutputRoot "capture_audit.json")) - Run-Python "RTK/IMU parse" @($Parser, "--rtk", $RtkCapture, "--imu", $ImuCapture, "--out", $ParsedRoot) -} - -foreach ($Station in $Stations) { - $StationOut = Join-Path $ExportRoot $Station.Name - if (-not $SkipLidarExport) { - Run-Python "LiDAR station $($Station.Name)" @( - $Exporter, "--dlog", $Station.FullName, "--out", $StationOut, - "--object", $LidarObject, "--format", "npz", "--timezone", $Timezone, - "--stride", "$Stride", "--compress", "--skip-rtk", "--write-reports", "--resume" - ) - } - if (-not (Test-Path -LiteralPath (Join-Path $StationOut "frames"))) { - throw "Exported frame directory is absent for station $($Station.Name): $StationOut" - } -} - -$BuildArgs = @($Builder) -foreach ($Station in $Stations) { - $Frames = Join-Path (Join-Path $ExportRoot $Station.Name) "frames" - $BuildArgs += @("--lidar", "$($Station.Name)=$Frames") -} -$BuildArgs += @( - "--rtk", (Join-Path $ParsedRoot "rtk.jsonl"), - "--imu", (Join-Path $ParsedRoot "imu.jsonl"), - "--out", $CombinedRoot, - "--rtk-max-dt-ms", "$RtkMaxDtMs", - "--imu-before-ms", "$ImuBeforeMs", - "--imu-after-ms", "$ImuAfterMs", - "--overwrite" -) -Run-Python "LiDAR/RTK/IMU association" $BuildArgs - -Write-Host "Completed stations: $($Stations.Count)" -Write-Host "Combined NPZ: $CombinedRoot" diff --git a/LiDAR_RTK_Direct_Calibration/run/prepare_multisensor_dataset.ps1 b/LiDAR_RTK_Direct_Calibration/run/prepare_multisensor_dataset.ps1 deleted file mode 100644 index a5b07a9..0000000 --- a/LiDAR_RTK_Direct_Calibration/run/prepare_multisensor_dataset.ps1 +++ /dev/null @@ -1,22 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$CombinedRoot, - [Parameter(Mandatory = $true)][string]$Output, - [Parameter(Mandatory = $true)][double]$HeadingOffsetDeg, - [Parameter(Mandatory = $true)][double[]]$AntennaLever, - [string]$PoseName = "rtk_gga_raw_heading", - [int]$MinStations = 30, - [int]$ExpectedStations = 0, - [double]$HeadingStdLimitDeg = 0.5, - [switch]$Overwrite -) - -$ErrorActionPreference = "Stop" -if ($AntennaLever.Count -ne 3) { throw "AntennaLever must contain X,Y,Z in body coordinates" } -$Repo = Split-Path -Parent $PSScriptRoot -$Args = @((Join-Path $Repo "tools\prepare_multisensor_station_dataset.py"), "--combined-root", $CombinedRoot, - "--output", $Output, "--pose-name", $PoseName, "--heading-offset-deg", "$HeadingOffsetDeg", "--antenna-lever") + - @($AntennaLever | ForEach-Object { "$_" }) + @("--min-stations", "$MinStations", - "--expected-stations", "$ExpectedStations", "--heading-std-limit-deg", "$HeadingStdLimitDeg") -if ($Overwrite) { $Args += "--overwrite" } -& python @Args -if ($LASTEXITCODE -ne 0) { throw "Multisensor dataset preparation failed" } diff --git a/LiDAR_RTK_Direct_Calibration/run/run_single_dataset.ps1 b/LiDAR_RTK_Direct_Calibration/run/run_single_dataset.ps1 deleted file mode 100644 index 3bf3e53..0000000 --- a/LiDAR_RTK_Direct_Calibration/run/run_single_dataset.ps1 +++ /dev/null @@ -1,70 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$Prepared, - [Parameter(Mandatory = $true)][string]$OutputRoot, - [string]$ReferencePoseFile = "reference_poses_rtk_gga_raw_heading.csv", - [double]$ReferenceHeight = 0.8535, - [int]$MinPairs = 20, - [int]$Bootstrap = 100 -) - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -$Code = Join-Path $Repo "code\rigorous_calibration.py" -$Refine = Join-Path $Repo "code\refine_pairs.py" -$Consensus = Join-Path $Repo "code\cross_backend_filter.py" -$Frames = Join-Path $Prepared "frames_all" -$ReferencePoses = Join-Path $Prepared $ReferencePoseFile -$Common = Join-Path $OutputRoot "common" -$Open = Join-Path $OutputRoot "open3d_gicp" -$Small = Join-Path $OutputRoot "small_gicp" -$ConsensusOut = Join-Path $OutputRoot "consensus" - -function Run-Python { - param([string]$Stage, [string[]]$Arguments) - Write-Host "[$Stage]" - & python @Arguments - if ($LASTEXITCODE -ne 0) { throw "$Stage failed with Python exit code $LASTEXITCODE" } -} - -foreach ($Path in @($Frames, $ReferencePoses)) { - if (-not (Test-Path -LiteralPath $Path)) { throw "Input does not exist: $Path" } -} -New-Item -ItemType Directory -Force -Path $Common,$Open,$Small,$ConsensusOut | Out-Null - -$Ground = Join-Path $Common "ground_planes.csv" -Run-Python "ground planes" @($Code, "ground", "--frames", $Frames, "--output", $Ground) - -foreach ($Backend in @("small_gicp", "open3d")) { - $Directory = if ($Backend -eq "small_gicp") { $Small } else { $Open } - $Raw = Join-Path $Directory "B_estimation.npz" - $QualityJson = Join-Path $Directory "B_quality.json" - $QualityCsv = Join-Path $Directory "B_quality.csv" - $PairArgs = @($Code, "pairs", "--backend", $Backend, "--frames", $Frames, "--reference-poses", $ReferencePoses, - "--output", $Raw, "--quality-json", $QualityJson, "--quality-csv", $QualityCsv, - "--min-pairs", "$MinPairs") - if ($Backend -eq "open3d") { $PairArgs += @("--max-gap", "3", "--multistart", "1", "--iterations", "40") } - Run-Python "$Backend pairs" $PairArgs - Run-Python "$Backend X-independent refinement" @( - $Refine, "--pairs", $Raw, "--quality-json", $QualityJson, - "--output", (Join-Path $Directory "B_refined.npz"), "--min-pairs", "$MinPairs" - ) - Run-Python "$Backend calibration" @( - $Code, "calibrate", "--pairs", (Join-Path $Directory "B_refined.npz"), - "--ground-planes", $Ground, "--reference-height", "$ReferenceHeight", - "--bootstrap", "$Bootstrap", "--output", (Join-Path $Directory "extrinsic.json") - ) -} - -$ConsensusPairs = Join-Path $ConsensusOut "B_consensus.npz" -Run-Python "cross-backend consensus" @( - $Consensus, "--open3d-pairs", (Join-Path $Open "B_refined.npz"), - "--small-pairs", (Join-Path $Small "B_refined.npz"), - "--output", $ConsensusPairs, "--min-pairs", "$MinPairs" -) -Run-Python "consensus calibration" @( - $Code, "calibrate", "--pairs", $ConsensusPairs, "--ground-planes", $Ground, - "--reference-height", "$ReferenceHeight", "--bootstrap", "$Bootstrap", - "--output", (Join-Path $ConsensusOut "extrinsic.json") -) - -Write-Host "Calibration results: $OutputRoot" diff --git a/LiDAR_RTK_Direct_Calibration/run/view_result.ps1 b/LiDAR_RTK_Direct_Calibration/run/view_result.ps1 deleted file mode 100644 index e513e61..0000000 --- a/LiDAR_RTK_Direct_Calibration/run/view_result.ps1 +++ /dev/null @@ -1,19 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$Frames, - [Parameter(Mandatory = $true)][string]$Pairs, - [Parameter(Mandatory = $true)][string]$Extrinsic, - [int]$PairIndex = 0, - [double]$LeftRollDeg = 0.0, - [double]$LeftPitchDeg = 0.0, - [double]$LeftYawDeg = 0.0 -) - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -foreach ($Path in @($Frames, $Pairs, $Extrinsic)) { - if (-not (Test-Path -LiteralPath $Path)) { throw "Input does not exist: $Path" } -} -& python (Join-Path $Repo "code\visualize_pair_3d.py") ` - --frames $Frames --pairs $Pairs --extrinsic $Extrinsic --pair-index $PairIndex ` - --left-rpy-deg $LeftRollDeg $LeftPitchDeg $LeftYawDeg -if ($LASTEXITCODE -ne 0) { throw "Visualization failed with Python exit code $LASTEXITCODE" } diff --git a/LiDAR_RTK_Direct_Calibration/tools/README.md b/LiDAR_RTK_Direct_Calibration/tools/README.md deleted file mode 100644 index c670433..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/README.md +++ /dev/null @@ -1,11 +0,0 @@ -# tools目录 - -| 文件 | 输入→输出 | -|---|---| -| `frontlidar_dlog_export.py` | LiDAR dlog → 逐帧原始点云NPZ;时间来自DObject post tick | -| `rscap_v2/parse_rtk_imu_v2.py` | RTK/IMU rscap → JSONL,保存校验状态、主机时间、GNSS/IMU设备字段和原始报文 | -| `rscap_v2/audit_capture_v2.py` | 检查rscap结构、时间范围和记录统计 | -| `build_multisensor_npz.py` | 按LiDAR帧最近邻关联GGA/heading,并附加IMU时间窗 → combined NPZ | -| `prepare_multisensor_station_dataset.py` | combined NPZ → 每站一帧`frames_all`和`reference_poses_*.csv` | - -当前标定只使用LiDAR和RTK;IMU保持原始传感器坐标,不参与点云去畸变或外参求解。prepared阶段对站内有效RTK取平均、对heading取圆均值,并选择有效帧序列的中间LiDAR帧。 diff --git a/LiDAR_RTK_Direct_Calibration/tools/build_multisensor_npz.py b/LiDAR_RTK_Direct_Calibration/tools/build_multisensor_npz.py deleted file mode 100644 index 2da2043..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/build_multisensor_npz.py +++ /dev/null @@ -1,312 +0,0 @@ -#!/usr/bin/env python3 -"""Build one LiDAR-centric NPZ per frame with matched RTK and an IMU window. - -Inputs are LiDAR frame NPZ files from frontlidar_dlog_export.py and parsed -RTK/IMU JSONL files from parse_rtk_imu_v2.py. Raw .rscap files remain the -traceability source; this script never modifies them. -""" - -from __future__ import annotations - -import argparse -import csv -import json -from pathlib import Path -from typing import Any - -import numpy as np - - -GPS_EPOCH_UNIX_NS = 315964800 * 1_000_000_000 - - -def parse_named_path(text: str) -> tuple[str, Path]: - if "=" not in text: - raise argparse.ArgumentTypeError("expected NAME=PATH") - name, raw_path = text.split("=", 1) - if not name.strip(): - raise argparse.ArgumentTypeError("segment name is empty") - return name.strip(), Path(raw_path) - - -def parse_args() -> argparse.Namespace: - parser = argparse.ArgumentParser() - parser.add_argument( - "--lidar", - type=parse_named_path, - action="append", - required=True, - metavar="NAME=FRAMES_DIR", - help="Repeat for each LiDAR segment; directory contains exported *.npz frames.", - ) - parser.add_argument("--rtk", type=Path, action="append", required=True, help="Parsed rtk.jsonl; repeat per session.") - parser.add_argument("--imu", type=Path, action="append", required=True, help="Parsed imu.jsonl; repeat per session.") - parser.add_argument("--out", type=Path, required=True) - parser.add_argument("--rtk-max-dt-ms", type=float, default=150.0) - parser.add_argument("--imu-before-ms", type=float, default=100.0) - parser.add_argument("--imu-after-ms", type=float, default=100.0) - parser.add_argument("--gps-utc-leap-seconds", type=int, default=18) - parser.add_argument("--overwrite", action="store_true") - return parser.parse_args() - - -def load_jsonl(paths: list[Path]) -> list[dict[str, Any]]: - rows: list[dict[str, Any]] = [] - for source_index, path in enumerate(paths): - source_file = str(path.resolve()) - with path.open("r", encoding="utf-8") as stream: - for line_number, line in enumerate(stream, start=1): - if not line.strip(): - continue - row = json.loads(line) - row["_source_file"] = source_file - row["_source_index"] = source_index - row["_source_line"] = line_number - rows.append(row) - return rows - - -def utf8_array(value: Any) -> np.ndarray: - return np.frombuffer(str(value if value is not None else "").encode("utf-8"), dtype=np.uint8) - - -def scalar(array: np.ndarray) -> Any: - return array.reshape(-1)[0].item() - - -def nearest_index(times: np.ndarray, target: int) -> int: - if not len(times): - return -1 - right = int(np.searchsorted(times, target, side="left")) - candidates = [index for index in (right - 1, right) if 0 <= index < len(times)] - return min(candidates, key=lambda index: abs(int(times[index]) - target)) - - -def estimate_imu_times(rows: list[dict[str, Any]]) -> list[dict[str, Any]]: - """Recover 100 Hz timing inside each serial chunk from device timestamps. - - A capture chunk has one host receive timestamp but may contain several IMU - frames. The last frame is anchored to the chunk receive time and earlier - frames are moved backwards by their device timestamp difference. - """ - groups: dict[tuple[int, int], list[dict[str, Any]]] = {} - for row in rows: - if not row.get("crc_valid") or row.get("device_timestamp_ms") is None: - continue - key = (int(row["_source_index"]), int(row.get("source_chunk_sequence_last", -1))) - groups.setdefault(key, []).append(row) - result: list[dict[str, Any]] = [] - for group in groups.values(): - group.sort(key=lambda row: (int(row["device_timestamp_ms"]), int(row["_source_line"]))) - last_device = int(group[-1]["device_timestamp_ms"]) - host_ns = int(group[-1]["host_receive_utc_ns"]) - for row in group: - delta_ms = (last_device - int(row["device_timestamp_ms"])) & 0xFFFFFFFF - if delta_ms > 60_000: - delta_ms = 0 - copied = dict(row) - copied["estimated_time_ns"] = host_ns - delta_ms * 1_000_000 - result.append(copied) - result.sort(key=lambda row: int(row["estimated_time_ns"])) - return result - - -def gnss_utc_ns(row: dict[str, Any], leap_seconds: int) -> int | None: - week, tow_ms = row.get("gnss_week"), row.get("gnss_tow_ms") - if week is None or tow_ms is None: - return None - seconds = int(week) * 604800 + float(tow_ms) / 1000.0 - leap_seconds - return GPS_EPOCH_UNIX_NS + int(round(seconds * 1_000_000_000)) - - -def numeric_array(rows: list[dict[str, Any]], key: str, dtype: Any, default: Any) -> np.ndarray: - return np.asarray([row.get(key, default) if row.get(key) is not None else default for row in rows], dtype=dtype) - - -def raw_frame_matrix(rows: list[dict[str, Any]]) -> tuple[np.ndarray, np.ndarray]: - frames = [bytes.fromhex(str(row.get("raw_frame_hex", ""))) for row in rows] - lengths = np.asarray([len(frame) for frame in frames], dtype=np.int32) - width = max(lengths, default=0) - matrix = np.zeros((len(frames), width), dtype=np.uint8) - for index, frame in enumerate(frames): - matrix[index, : len(frame)] = np.frombuffer(frame, dtype=np.uint8) - return matrix, lengths - - -def add_rtk(values: dict[str, np.ndarray], prefix: str, row: dict[str, Any] | None, dt_ns: int | None) -> None: - values[f"{prefix}_valid"] = np.asarray([row is not None], dtype=np.uint8) - values[f"{prefix}_dt_ns"] = np.asarray([dt_ns or 0], dtype=np.int64) - values[f"{prefix}_host_receive_utc_ns"] = np.asarray([0], dtype=np.int64) - values[f"{prefix}_raw_utf8"] = utf8_array("") - values[f"{prefix}_source_file_utf8"] = utf8_array("") - values[f"{prefix}_source_raw_file_offset"] = np.asarray([-1], dtype=np.int64) - values[f"{prefix}_source_raw_byte_length"] = np.asarray([0], dtype=np.int32) - if row is None: - return - values[f"{prefix}_host_receive_utc_ns"] = np.asarray([row.get("host_receive_utc_ns", 0)], dtype=np.int64) - values[f"{prefix}_raw_utf8"] = utf8_array(row.get("raw_line", "")) - values[f"{prefix}_source_file_utf8"] = utf8_array(row.get("_source_file", "")) - values[f"{prefix}_source_raw_file_offset"] = np.asarray([row.get("source_raw_file_offset", -1)], dtype=np.int64) - values[f"{prefix}_source_raw_byte_length"] = np.asarray([row.get("source_raw_byte_length", 0)], dtype=np.int32) - - -def initialize_rtk_measurements(values: dict[str, np.ndarray]) -> None: - for key, dtype, default in ( - ("lat_deg", np.float64, np.nan), ("lon_deg", np.float64, np.nan), - ("altitude_m", np.float64, np.nan), ("hdop", np.float64, np.nan), - ("fix_quality", np.int32, -1), ("gga_satellites", np.int32, -1), - ("differential_age_s", np.float64, np.nan), - ("gnss_week", np.int32, -1), ("gnss_tow_ms", np.int64, -1), - ("baseline_length_m", np.float64, np.nan), ("raw_heading_deg", np.float64, np.nan), - ("pitch_deg", np.float64, np.nan), ("heading_stddev_deg", np.float64, np.nan), - ("pitch_stddev_deg", np.float64, np.nan), ("heading_satellites", np.int32, -1), - ("solution_satellites", np.int32, -1), - ): - values[f"rtk_{key}"] = np.asarray([default], dtype=dtype) - values["rtk_fixed"] = np.asarray([0], dtype=np.uint8) - values["rtk_heading_solution_utf8"] = utf8_array("") - values["rtk_heading_gnss_utc_ns"] = np.asarray([0], dtype=np.int64) - values["rtk_heading_host_minus_gnss_ns"] = np.asarray([0], dtype=np.int64) - -def main() -> int: - args = parse_args() - if args.out.exists() and any(args.out.iterdir()) and not args.overwrite: - raise FileExistsError(f"{args.out} is non-empty; pass --overwrite") - frames_out = args.out / "frames" - frames_out.mkdir(parents=True, exist_ok=True) - - rtk_rows = load_jsonl(args.rtk) - gga = sorted( - [row for row in rtk_rows if row.get("type") == "GGA" and row.get("checksum_valid") and row.get("lat_deg") is not None], - key=lambda row: int(row["host_receive_utc_ns"]), - ) - heading = sorted( - [row for row in rtk_rows if row.get("type") == "UNIHEADINGA" and row.get("checksum_valid") and row.get("heading_valid")], - key=lambda row: int(row["host_receive_utc_ns"]), - ) - imu = estimate_imu_times(load_jsonl(args.imu)) - gga_times = np.asarray([int(row["host_receive_utc_ns"]) for row in gga], dtype=np.int64) - heading_times = np.asarray([int(row["host_receive_utc_ns"]) for row in heading], dtype=np.int64) - imu_times = np.asarray([int(row["estimated_time_ns"]) for row in imu], dtype=np.int64) - - manifest: list[dict[str, Any]] = [] - global_index = 0 - max_rtk_ns = int(args.rtk_max_dt_ms * 1_000_000) - before_ns = int(args.imu_before_ms * 1_000_000) - after_ns = int(args.imu_after_ms * 1_000_000) - - for segment_name, frame_dir in args.lidar: - frame_paths = sorted(frame_dir.glob("*.npz")) - if not frame_paths: - raise FileNotFoundError(f"no NPZ frames under {frame_dir}") - for segment_index, source in enumerate(frame_paths): - with np.load(source, allow_pickle=False) as frame: - values = {key: np.asarray(frame[key]) for key in frame.files} - lidar_time_ns = int(scalar(values["unix_time_ns"])) - - gga_index = nearest_index(gga_times, lidar_time_ns) - heading_index = nearest_index(heading_times, lidar_time_ns) - gga_row = gga[gga_index] if gga_index >= 0 else None - heading_row = heading[heading_index] if heading_index >= 0 else None - gga_dt = int(gga_times[gga_index]) - lidar_time_ns if gga_index >= 0 else None - heading_dt = int(heading_times[heading_index]) - lidar_time_ns if heading_index >= 0 else None - gga_ok = gga_row is not None and abs(gga_dt or 0) <= max_rtk_ns - heading_ok = heading_row is not None and abs(heading_dt or 0) <= max_rtk_ns - add_rtk(values, "rtk_gga", gga_row if gga_ok else None, gga_dt) - add_rtk(values, "rtk_heading", heading_row if heading_ok else None, heading_dt) - initialize_rtk_measurements(values) - - if gga_ok and gga_row: - for key, dtype, default in ( - ("lat_deg", np.float64, np.nan), ("lon_deg", np.float64, np.nan), - ("altitude_m", np.float64, np.nan), ("hdop", np.float64, np.nan), - ("fix_quality", np.int32, -1), ("gga_satellites", np.int32, -1), - ("differential_age_s", np.float64, np.nan), - ): - values[f"rtk_{key}"] = np.asarray([gga_row.get(key, default)], dtype=dtype) - values["rtk_gga_satellites"] = np.asarray([gga_row.get("satellites", -1)], dtype=np.int32) - values["rtk_fixed"] = np.asarray([int(gga_row.get("fix_quality", -1)) in {4, 5}], dtype=np.uint8) - if heading_ok and heading_row: - for key, dtype, default in ( - ("gnss_week", np.int32, -1), ("gnss_tow_ms", np.int64, -1), - ("baseline_length_m", np.float64, np.nan), ("raw_heading_deg", np.float64, np.nan), - ("pitch_deg", np.float64, np.nan), ("heading_stddev_deg", np.float64, np.nan), - ("pitch_stddev_deg", np.float64, np.nan), - ("solution_satellites", np.int32, -1), - ): - values[f"rtk_{key}"] = np.asarray([heading_row.get(key, default)], dtype=dtype) - values["rtk_heading_satellites"] = np.asarray([heading_row.get("satellites", -1)], dtype=np.int32) - values["rtk_heading_solution_utf8"] = utf8_array(heading_row.get("heading_solution", "")) - device_ns = gnss_utc_ns(heading_row, args.gps_utc_leap_seconds) - values["rtk_heading_gnss_utc_ns"] = np.asarray([device_ns or 0], dtype=np.int64) - values["rtk_heading_host_minus_gnss_ns"] = np.asarray( - [int(heading_row["host_receive_utc_ns"]) - device_ns if device_ns is not None else 0], dtype=np.int64 - ) - - left = int(np.searchsorted(imu_times, lidar_time_ns - before_ns, side="left")) - right = int(np.searchsorted(imu_times, lidar_time_ns + after_ns, side="right")) - window = imu[left:right] - values["imu_window_count"] = np.asarray([len(window)], dtype=np.int32) - values["imu_valid"] = np.asarray([bool(window)], dtype=np.uint8) - values["imu_time_ns"] = numeric_array(window, "estimated_time_ns", np.int64, 0) - values["imu_host_receive_utc_ns"] = numeric_array(window, "host_receive_utc_ns", np.int64, 0) - for key in ("device_timestamp_ms", "pps_sync_stamp_ms", "tag"): - values[f"imu_{key}"] = numeric_array(window, key, np.int64, -1) - for key in ( - "temperature_c", "air_pressure_pa", "accel_x_mps2", "accel_y_mps2", "accel_z_mps2", - "gyro_x_radps", "gyro_y_radps", "gyro_z_radps", "mag_x_ut", "mag_y_ut", "mag_z_ut", - "roll_deg", "pitch_deg", "yaw_deg", "quaternion_w", "quaternion_x", "quaternion_y", "quaternion_z", - ): - values[f"imu_{key}"] = numeric_array(window, key, np.float64, np.nan) - values["imu_source_index"] = numeric_array(window, "_source_index", np.int32, -1) - values["imu_source_raw_file_offset"] = numeric_array(window, "source_raw_file_offset", np.int64, -1) - raw_matrix, raw_lengths = raw_frame_matrix(window) - values["imu_raw_frame_bytes"] = raw_matrix - values["imu_raw_frame_length"] = raw_lengths - values["imu_source_files_json_utf8"] = utf8_array(json.dumps([str(path.resolve()) for path in args.imu], ensure_ascii=False)) - values["source_lidar_file_utf8"] = utf8_array(source.resolve()) - values["segment_name_utf8"] = utf8_array(segment_name) - - output = frames_out / f"{segment_name}_{segment_index:06d}.npz" - np.savez_compressed(output, **values) - manifest.append({ - "global_index": global_index, - "segment": segment_name, - "segment_index": segment_index, - "output": str(output.relative_to(args.out)), - "source_lidar": str(source.resolve()), - "lidar_time_ns": lidar_time_ns, - "rtk_gga_dt_ns": gga_dt, - "rtk_heading_dt_ns": heading_dt, - "rtk_valid": gga_ok, - "heading_valid": heading_ok, - "rtk_fix_quality": gga_row.get("fix_quality") if gga_ok and gga_row else None, - "rtk_fixed": bool(gga_ok and gga_row and int(gga_row.get("fix_quality", -1)) in {4, 5}), - "imu_window_count": len(window), - }) - global_index += 1 - - fields = sorted({key for row in manifest for key in row}) - with (args.out / "manifest.csv").open("w", encoding="utf-8", newline="") as stream: - writer = csv.DictWriter(stream, fieldnames=fields) - writer.writeheader() - writer.writerows(manifest) - summary = { - "frames": len(manifest), - "segments": {name: sum(row["segment"] == name for row in manifest) for name, _ in args.lidar}, - "rtk_valid": sum(bool(row["rtk_valid"]) for row in manifest), - "heading_valid": sum(bool(row["heading_valid"]) for row in manifest), - "rtk_fixed": sum(bool(row["rtk_fixed"]) for row in manifest), - "imu_window_nonempty": sum(int(row["imu_window_count"]) > 0 for row in manifest), - "rtk_max_dt_ms": args.rtk_max_dt_ms, - "imu_window_ms": [-args.imu_before_ms, args.imu_after_ms], - "time_basis": "LiDAR and serial host UTC; RTK GNSS time and IMU device time are retained for clock-model refinement", - "imu_orientation_warning": "IMU values are in the raw IMU sensor frame; no LiDAR/body extrinsic is applied", - } - (args.out / "dataset_summary.json").write_text(json.dumps(summary, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps(summary, ensure_ascii=False, indent=2)) - return 0 - - -if __name__ == "__main__": - raise SystemExit(main()) diff --git a/LiDAR_RTK_Direct_Calibration/tools/frontlidar_dlog_export.py b/LiDAR_RTK_Direct_Calibration/tools/frontlidar_dlog_export.py deleted file mode 100644 index 9bfd2fa..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/frontlidar_dlog_export.py +++ /dev/null @@ -1,1963 +0,0 @@ -#!/usr/bin/env python3 -"""Export Medulla DObject lidar + RTK recordings to sharded NumPy NPZ / pickle. - -The default NPZ path uses only the Python standard library; NumPy is required -only when consuming the exported files, not while exporting them. -""" - -from __future__ import annotations - -import argparse -import array -import bisect -import csv -import io -import json -import math -import os -import pickle -import re -import struct -import sys -import time -import zipfile -from contextlib import nullcontext -from dataclasses import asdict, dataclass -from datetime import datetime, timedelta, timezone -from pathlib import Path -from typing import BinaryIO, Iterable, Iterator, Sequence - - -RECORD_RE = re.compile( - r"^\[(?P[^]]+)\].*?DObject `(?P[^`]+)` post " - r"len=(?P\d+)B, id:(?P[0-9A-Fa-f]+), tic:(?P\d+), " - r"@(?P[^:]+):(?P\d+)" -) -GPS_TEXT_RE = re.compile( - r"^\[(?P[^]]+)\].*?\$GPS-POST-Z>text\)>(?P.+)$" -) -POINT_STRUCT = struct.Struct("<5f") -DOTNET_UNIX_EPOCH_TICKS = 621355968000000000 -TICKS_PER_SECOND = 10_000_000 -TICKS_PER_DAY = 864_000_000_000 -NS_PER_TICK = 100 -FORMAT_VERSION = "medulla-lidar3d-rtk-v2" -RTK_OBJECT_NAMES = ("GPS-POST-Z", "rtk", "GPS-POST") - - -@dataclass(frozen=True) -class RecordRef: - sequence: int - object_name: str - log_time: str - source_log: str - source_dorec: str - source_offset: int - payload_length: int - log_record_id: str - dotnet_ticks: int - - -@dataclass -class RtkSample: - index: int - source: str - object_name: str - dotnet_ticks: int - timestamp_iso_local: str - unix_time_ns: int - log_time: str - record_id: str - source_log: str - source_dorec: str - source_offset: int - payload_length: int - counter: int | None = None - lat: float | None = None - lon: float | None = None - alt_m: float | None = None - raw_heading_deg: float | None = None - vehicle_heading_deg: float | None = None - fix: int | None = None - sat: int | None = None - position_valid: bool | None = None - heading_valid: bool | None = None - heading_solution: str | None = None - position_time: str | None = None - heading_time: str | None = None - last_line: str | None = None - device_name: str | None = None - device_stamp_hex: str | None = None - raw_text: str | None = None - parse_error: str | None = None - - -def parse_args() -> argparse.Namespace: - parser = argparse.ArgumentParser( - description=( - "Export Medulla frontlidar dlog records with matched RTK/GPS-POST-Z " - "to per-frame NPZ or pickle files." - ) - ) - parser.add_argument("--dlog", required=True, help="Directory containing dobject/ and dobject_recording/.") - parser.add_argument("--out", required=True, help="Output dataset directory.") - parser.add_argument("--object", default="frontlidar", help="Lidar DObject name; default: frontlidar.") - parser.add_argument("--format", choices=("npz", "pickle"), default="npz") - parser.add_argument("--timezone", default="+08:00", help="Fixed offset used to interpret DateTime.Now.Ticks.") - parser.add_argument("--stride", type=int, default=1, help="Export every Nth lidar frame.") - parser.add_argument("--max-frames", type=int, default=0, help="0 exports all selected frames.") - parser.add_argument("--resume", action="store_true", help="Keep already exported frame files.") - parser.add_argument("--compress", action="store_true", help="Use ZIP deflate level 1 for NPZ files.") - parser.add_argument( - "--include-xyz", - choices=("none", "sensor", "cart", "both"), - default="none", - help="Optionally generate XYZ arrays. Raw N x 5 data is always exported.", - ) - parser.add_argument("--x", type=float, default=736.0, help="Lidar X in vehicle frame, mm.") - parser.add_argument("--y", type=float, default=0.0, help="Lidar Y in vehicle frame, mm.") - parser.add_argument("--z", type=float, default=0.0, help="Lidar Z in vehicle frame, mm.") - parser.add_argument("--yaw", type=float, default=0.0, help="Yaw in degrees.") - parser.add_argument("--pitch", type=float, default=0.0, help="Pitch in degrees.") - parser.add_argument("--roll", type=float, default=0.0, help="Roll in degrees.") - parser.add_argument( - "--rtk-max-dt-ms", - type=float, - default=1000.0, - help=( - "Fail rtk_time_alignment when an interior frame's nearest |dt| exceeds this many " - "milliseconds. Edge frames before the first / after the last RTK are reported " - "separately and do not fail the check." - ), - ) - parser.add_argument( - "--skip-rtk", - action="store_true", - help="Export lidar only (no per-frame RTK matching).", - ) - parser.add_argument( - "--rtk-sidecars", - action="store_true", - help=( - "Also write rtk/ sidecars (gps_post_z / rtk_binary / gps_post / text). " - "Default is off; per-frame NPZ still embeds matched RTK fields." - ), - ) - parser.add_argument( - "--write-reports", - action="store_true", - help=( - "Write audit files under reports/ (metadata.json, manifest.csv, " - "rtk_match.csv, validation_report.json). Default package only has " - "frames/ and README.md." - ), - ) - args = parser.parse_args() - if args.stride < 1: - parser.error("--stride must be >= 1") - if args.max_frames < 0: - parser.error("--max-frames must be >= 0") - if args.rtk_max_dt_ms < 0: - parser.error("--rtk-max-dt-ms must be >= 0") - if args.skip_rtk and args.rtk_sidecars: - parser.error("--rtk-sidecars cannot be used with --skip-rtk") - parse_timezone(args.timezone) - return args - - -def resolve_dlog_root(value: str) -> Path: - root = Path(value).expanduser().resolve() - if (root / "dobject").is_dir() and (root / "dobject_recording").is_dir(): - return root - child = root / "dlog" - if (child / "dobject").is_dir() and (child / "dobject_recording").is_dir(): - return child - raise FileNotFoundError(f"{root} does not contain dobject and dobject_recording") - - -def parse_timezone(text: str) -> timezone: - match = re.fullmatch(r"([+-])(\d{2}):(\d{2})", text.strip()) - if not match: - raise ValueError(f"invalid timezone offset: {text!r}") - minutes = int(match.group(2)) * 60 + int(match.group(3)) - if match.group(1) == "-": - minutes = -minutes - return timezone(timedelta(minutes=minutes)) - - -def timezone_minutes(tz: timezone) -> int: - return int(tz.utcoffset(None).total_seconds() // 60) - - -def dotnet_ticks_to_values(ticks: int, tz: timezone) -> tuple[str, int]: - days, remainder = divmod(ticks, TICKS_PER_DAY) - seconds, subsecond_ticks = divmod(remainder, TICKS_PER_SECOND) - local_dt = datetime(1, 1, 1) + timedelta(days=days, seconds=seconds) - fraction = f"{subsecond_ticks:07d}" - offset = tz.utcoffset(None) - sign = "+" if offset >= timedelta(0) else "-" - total_minutes = abs(int(offset.total_seconds() // 60)) - iso = f"{local_dt:%Y-%m-%dT%H:%M:%S}.{fraction}{sign}{total_minutes // 60:02d}:{total_minutes % 60:02d}" - offset_ticks = int(offset.total_seconds()) * TICKS_PER_SECOND - unix_ns = (ticks - DOTNET_UNIX_EPOCH_TICKS - offset_ticks) * NS_PER_TICK - return iso, unix_ns - - -def discover_records(dlog_root: Path, object_name: str) -> list[RecordRef]: - pending: list[tuple[str, str, str, int, int, str, int, str]] = [] - for log_path in sorted((dlog_root / "dobject").rglob("*.log")): - relative_log = log_path.relative_to(dlog_root).as_posix() - with log_path.open("r", encoding="utf-8", errors="replace") as stream: - for line in stream: - match = RECORD_RE.search(line) - if not match or match.group("name").casefold() != object_name.casefold(): - continue - pending.append( - ( - match.group("name"), - match.group("log_time"), - relative_log, - int(match.group("offset")), - int(match.group("len")), - match.group("id").upper(), - int(match.group("tic")), - match.group("file"), - ) - ) - pending.sort(key=lambda item: (item[6], item[7].casefold(), item[3])) - seen: set[tuple[str, int, int]] = set() - records: list[RecordRef] = [] - for item in pending: - key = (item[7].casefold(), item[3], item[6]) - if key in seen: - continue - seen.add(key) - records.append( - RecordRef( - sequence=len(records), - object_name=item[0], - log_time=item[1], - source_log=item[2], - source_dorec=item[7], - source_offset=item[3], - payload_length=item[4], - log_record_id=item[5], - dotnet_ticks=item[6], - ) - ) - return records - - -def index_dorec_files(dlog_root: Path) -> dict[str, list[Path]]: - result: dict[str, list[Path]] = {} - for path in (dlog_root / "dobject_recording").rglob("*.dorec"): - result.setdefault(path.name.casefold(), []).append(path) - return result - - -def choose_dorec(index: dict[str, list[Path]], name: str) -> Path: - matches = index.get(Path(name).name.casefold(), []) - if not matches: - raise FileNotFoundError(f"missing recording file: {name}") - if len(matches) > 1: - raise RuntimeError(f"ambiguous recording file {name}: {matches}") - return matches[0] - - -def read_exact(stream: BinaryIO, size: int) -> bytes: - data = stream.read(size) - if len(data) != size: - raise EOFError(f"expected {size} bytes, got {len(data)}") - return data - - -def read_record(path: Path, record: RecordRef) -> tuple[dict[str, object], bytes]: - with path.open("rb") as stream: - stream.seek(record.source_offset) - name_length = read_exact(stream, 1)[0] - name = read_exact(stream, name_length).decode("ascii") - ticks = struct.unpack(" tuple[int, int, bytes]: - if len(payload) < 8: - raise ValueError(f"payload too short: {len(payload)}") - frame_counter, point_count = struct.unpack_from(" tuple[str, int]: - if pos >= len(data): - raise ValueError("truncated length-prefixed string") - length = data[pos] - pos += 1 - end = pos + length - if end > len(data): - raise ValueError("truncated length-prefixed string body") - return data[pos:end].decode("ascii", errors="replace"), end - - -def parse_bool_text(value: str) -> bool | None: - lowered = value.strip().casefold() - if lowered in ("true", "1", "yes"): - return True - if lowered in ("false", "0", "no"): - return False - return None - - -def parse_kv_payload(text: str, separators: Sequence[str] = ("=", ":")) -> dict[str, str]: - result: dict[str, str] = {} - for part in text.replace("\r", "").replace("\n", ",").split(","): - part = part.strip() - if not part: - continue - key = value = None - for sep in separators: - if sep in part: - key, value = part.split(sep, 1) - break - if key is None or value is None: - continue - result[key.strip()] = value.strip() - return result - - -def coerce_int(value: str | None) -> int | None: - if value is None or value == "": - return None - try: - return int(float(value)) - except ValueError: - return None - - -def coerce_float(value: str | None) -> float | None: - if value is None or value == "": - return None - try: - return float(value) - except ValueError: - return None - - -def parse_gps_post_z_text(text: str) -> dict[str, object]: - fields = parse_kv_payload(text, separators=("=", ":")) - alt = fields.get("alt", fields.get("h")) - vehicle_heading = fields.get("vehicleHeading", fields.get("th")) - return { - "counter": coerce_int(fields.get("counter")), - "lat": coerce_float(fields.get("lat")), - "lon": coerce_float(fields.get("lon")), - "alt_m": coerce_float(alt), - "raw_heading_deg": coerce_float(fields.get("rawHeading")), - "vehicle_heading_deg": coerce_float(vehicle_heading), - "fix": coerce_int(fields.get("fix")), - "sat": coerce_int(fields.get("sat")), - "position_valid": parse_bool_text(fields.get("positionValid", "")), - "heading_valid": parse_bool_text(fields.get("headingValid", "")), - "heading_solution": fields.get("headingSolution"), - "position_time": fields.get("positionTime"), - "heading_time": fields.get("headingTime"), - "last_line": fields.get("lastLine"), - "time_field": fields.get("time"), - "raw_fields": fields, - } - - -def parse_rtk_binary_payload(payload: bytes) -> dict[str, object]: - pos = 0 - device_name, pos = read_len_prefixed_ascii(payload, pos) - version, counter, unknown0 = struct.unpack_from("= len(payload): - raise ValueError("rtk payload truncated before validity flags") - position_valid = bool(payload[pos]) - pos += 1 - raw_heading, vehicle_heading = struct.unpack_from("= len(payload): - raise ValueError("rtk payload truncated before heading validity") - heading_valid = bool(payload[pos]) - pos += 1 - heading_solution, pos = read_len_prefixed_ascii(payload, pos) - has_nmea = bool(payload[pos]) if pos < len(payload) else False - if pos < len(payload): - pos += 1 - last_line = None - if has_nmea and pos < len(payload): - last_line, pos = read_len_prefixed_ascii(payload, pos) - return { - "device_name": device_name, - "version": version, - "counter": counter, - "unknown0": unknown0, - "device_stamp_hex": device_stamp.hex().upper(), - "position_time": position_time, - "heading_time": heading_time, - "lat": lat, - "lon": lon, - "alt_m": alt, - "reserved0": reserved0, - "reserved1": reserved1, - "fix": fix, - "sat": sat, - "position_valid": position_valid, - "raw_heading_deg": raw_heading, - "vehicle_heading_deg": vehicle_heading, - "heading_valid": heading_valid, - "heading_solution": heading_solution, - "last_line": last_line, - "bytes_consumed": pos, - "payload_length": len(payload), - } - - -def parse_gps_post_payload(payload: bytes) -> dict[str, object]: - pos = 0 - name, pos = read_len_prefixed_ascii(payload, pos) - if pos + 20 > len(payload): - raise ValueError("GPS-POST payload too short") - counter, unknown0 = struct.unpack_from(" tuple[float, ...]: - yaw, pitch, roll = map(math.radians, (yaw_deg, pitch_deg, roll_deg)) - cy, sy = math.cos(yaw), math.sin(yaw) - cp, sp = math.cos(pitch), math.sin(pitch) - cr, sr = math.cos(roll), math.sin(roll) - return ( - cy * cp, - -sy * cr + cy * sp * sr, - sy * sr + cy * sp * cr, - sy * cp, - cy * cr + sy * sp * sr, - -cy * sr + sy * sp * cr, - -sp, - cp * sr, - cp * cr, - ) - - -def generate_xyz( - raw_points: bytes, - mode: str, - translation: tuple[float, float, float], - rotation: tuple[float, ...], -) -> tuple[bytes | None, bytes | None]: - need_sensor = mode in ("sensor", "both") - need_cart = mode in ("cart", "both") - sensor = array.array("f") if need_sensor else None - cart = array.array("f") if need_cart else None - tx, ty, tz = translation - r = rotation - for distance, azimuth, altitude, _intensity, _progression in POINT_STRUCT.iter_unpack(raw_points): - alt = math.radians(altitude) - azi = math.radians(azimuth) - cos_alt = math.cos(alt) - sx = distance * cos_alt * math.cos(azi) - sy = distance * cos_alt * math.sin(azi) - sz = distance * math.sin(alt) - if sensor is not None: - sensor.extend((sx, sy, sz)) - if cart is not None: - cart.extend( - ( - r[0] * sx + r[1] * sy + r[2] * sz + tx, - r[3] * sx + r[4] * sy + r[5] * sz + ty, - r[6] * sx + r[7] * sy + r[8] * sz + tz, - ) - ) - if sys.byteorder != "little": - if sensor is not None: - sensor.byteswap() - if cart is not None: - cart.byteswap() - return (sensor.tobytes() if sensor is not None else None, cart.tobytes() if cart is not None else None) - - -def numpy_header(descr: str, shape: Sequence[int]) -> bytes: - shape_text = "(" + ", ".join(str(value) for value in shape) - if len(shape) == 1: - shape_text += "," - shape_text += ")" - header = f"{{'descr': '{descr}', 'fortran_order': False, 'shape': {shape_text}, }}" - encoded = header.encode("latin-1") - padding = (-((10 + len(encoded) + 1) % 16)) % 16 - encoded += b" " * padding + b"\n" - if len(encoded) > 65535: - raise ValueError("NPY v1 header is too long") - return b"\x93NUMPY\x01\x00" + struct.pack(" None: - with archive.open(name + ".npy", "w", force_zip64=True) as entry: - entry.write(numpy_header(descr, shape)) - entry.write(data) - - -def scalar_bytes(fmt: str, value: int | float) -> bytes: - return struct.pack(fmt, value) - - -def open_npz_writer(path: Path, compress: bool) -> zipfile.ZipFile: - compression = zipfile.ZIP_DEFLATED if compress else zipfile.ZIP_STORED - kwargs: dict[str, object] = {"compression": compression, "allowZip64": True} - if compress: - kwargs["compresslevel"] = 1 - return zipfile.ZipFile(path, "w", **kwargs) - - -def pack_f64_array(values: Sequence[float]) -> bytes: - data = array.array("d", values) - if sys.byteorder != "little": - data.byteswap() - return data.tobytes() - - -def pack_i8_array(values: Sequence[int]) -> bytes: - data = array.array("q", values) - if sys.byteorder != "little": - data.byteswap() - return data.tobytes() - - -def pack_i4_array(values: Sequence[int]) -> bytes: - data = array.array("i", values) - if sys.byteorder != "little": - data.byteswap() - return data.tobytes() - - -def pack_u1_bools(values: Sequence[bool | None]) -> bytes: - return bytes(1 if value else 0 for value in values) - - -def export_npz( - path: Path, - metadata: dict[str, object], - raw_points: bytes, - point_count: int, - xyz_sensor: bytes | None, - xyz_cart: bytes | None, - compress: bool, - rtk_arrays: dict[str, tuple[str, Sequence[int], bytes]] | None = None, -) -> None: - temp = path.with_suffix(path.suffix + ".tmp") - with open_npz_writer(temp, compress) as archive: - write_npy_entry(archive, "points_raw", " None: - points = array.array("f") - points.frombytes(raw_points) - if sys.byteorder != "little": - points.byteswap() - frame: dict[str, object] = { - "metadata": metadata, - "point_columns": ("d_mm", "azimuth_deg", "altitude_deg", "intensity", "progression"), - "points_raw_flat_f32": points, - "points_raw_shape": (point_count, 5), - } - for key, raw in (("xyz_sensor_mm_flat_f32", xyz_sensor), ("xyz_cart_mm_flat_f32", xyz_cart)): - if raw is not None: - values = array.array("f") - values.frombytes(raw) - if sys.byteorder != "little": - values.byteswap() - frame[key] = values - frame[key.replace("_flat_f32", "_shape")] = (point_count, 3) - temp = path.with_suffix(path.suffix + ".tmp") - with temp.open("wb") as stream: - pickle.dump(frame, stream, protocol=5) - os.replace(temp, path) - - -def frame_filename(record: RecordRef, frame_counter: int, extension: str) -> str: - return f"{record.object_name}_{record.sequence:06d}_{record.dotnet_ticks}_frame{frame_counter:010d}.{extension}" - - -def manifest_fields(include_rtk: bool) -> list[str]: - fields = [ - "sequence", - "status", - "object_name", - "dotnet_ticks", - "timestamp_iso_local", - "unix_time_ns", - "log_time", - "record_id", - "record_id_bytes_hex", - "frame_counter", - "point_count", - "payload_length", - "source_log", - "source_dorec", - "source_offset", - "output_file", - "error", - ] - if include_rtk: - fields.extend( - [ - "rtk_matched", - "rtk_nearest_index", - "rtk_prev_index", - "rtk_next_index", - "rtk_dt_ns", - "rtk_prev_dt_ns", - "rtk_next_dt_ns", - "rtk_lat", - "rtk_lon", - "rtk_alt_m", - "rtk_vehicle_heading_deg", - "rtk_raw_heading_deg", - "rtk_fix", - "rtk_sat", - "rtk_position_valid", - "rtk_heading_valid", - "rtk_heading_solution", - ] - ) - return fields - - -def nan_if_none(value: float | None) -> float: - return float("nan") if value is None else float(value) - - -def int_or_sentinel(value: int | None, sentinel: int = -1) -> int: - return sentinel if value is None else int(value) - - -def bool_or_false(value: bool | None) -> bool: - return bool(value) - - -def sample_to_public_dict(sample: RtkSample) -> dict[str, object]: - data = asdict(sample) - return data - - -def write_jsonl(path: Path, rows: Iterable[dict[str, object]]) -> int: - count = 0 - with path.open("w", encoding="utf-8") as stream: - for row in rows: - stream.write(json.dumps(row, ensure_ascii=False, separators=(",", ":"))) - stream.write("\n") - count += 1 - return count - - -def write_csv_rows(path: Path, fieldnames: Sequence[str], rows: Iterable[dict[str, object]]) -> int: - count = 0 - with path.open("w", newline="", encoding="utf-8-sig") as stream: - writer = csv.DictWriter(stream, fieldnames=list(fieldnames), extrasaction="ignore") - writer.writeheader() - for row in rows: - writer.writerow({key: row.get(key, "") for key in fieldnames}) - count += 1 - return count - - -def export_rtk_table_npz(path: Path, samples: Sequence[RtkSample], compress: bool) -> None: - n = len(samples) - temp = path.with_suffix(path.suffix + ".tmp") - with open_npz_writer(temp, compress) as archive: - write_npy_entry(archive, "index", " tuple[list[RtkSample], dict[str, int]]: - records = discover_records(root, "GPS-POST-Z") - samples: list[RtkSample] = [] - stats = { - "discovered": len(records), - "parsed_ok": 0, - "parse_errors": 0, - "read_errors": 0, - } - for record in records: - timestamp_iso, unix_ns = dotnet_ticks_to_values(record.dotnet_ticks, tz) - sample = RtkSample( - index=len(samples), - source="dobject", - object_name=record.object_name, - dotnet_ticks=record.dotnet_ticks, - timestamp_iso_local=timestamp_iso, - unix_time_ns=unix_ns, - log_time=record.log_time, - record_id=record.log_record_id, - source_log=record.source_log, - source_dorec=record.source_dorec, - source_offset=record.source_offset, - payload_length=record.payload_length, - ) - try: - dorec_path = choose_dorec(dorec_index, record.source_dorec) - record_meta, payload = read_record(dorec_path, record) - sample.record_id = str(record_meta["record_id"]) - text = payload.decode("utf-8", errors="replace") - sample.raw_text = text - parsed = parse_gps_post_z_text(text) - sample.counter = parsed["counter"] # type: ignore[assignment] - sample.lat = parsed["lat"] # type: ignore[assignment] - sample.lon = parsed["lon"] # type: ignore[assignment] - sample.alt_m = parsed["alt_m"] # type: ignore[assignment] - sample.raw_heading_deg = parsed["raw_heading_deg"] # type: ignore[assignment] - sample.vehicle_heading_deg = parsed["vehicle_heading_deg"] # type: ignore[assignment] - sample.fix = parsed["fix"] # type: ignore[assignment] - sample.sat = parsed["sat"] # type: ignore[assignment] - sample.position_valid = parsed["position_valid"] # type: ignore[assignment] - sample.heading_valid = parsed["heading_valid"] # type: ignore[assignment] - sample.heading_solution = parsed["heading_solution"] # type: ignore[assignment] - sample.position_time = parsed["position_time"] # type: ignore[assignment] - sample.heading_time = parsed["heading_time"] # type: ignore[assignment] - sample.last_line = parsed["last_line"] # type: ignore[assignment] - stats["parsed_ok"] += 1 - except Exception as exc: - sample.parse_error = f"{type(exc).__name__}: {exc}" - if "read" in type(exc).__name__.casefold() or "mismatch" in str(exc).casefold(): - stats["read_errors"] += 1 - else: - stats["parse_errors"] += 1 - samples.append(sample) - _ = timezone_text - return samples, stats - - -def load_rtk_binary_samples( - root: Path, - dorec_index: dict[str, list[Path]], - tz: timezone, -) -> tuple[list[RtkSample], dict[str, int]]: - records = discover_records(root, "rtk") - samples: list[RtkSample] = [] - stats = {"discovered": len(records), "parsed_ok": 0, "parse_errors": 0, "read_errors": 0} - for record in records: - timestamp_iso, unix_ns = dotnet_ticks_to_values(record.dotnet_ticks, tz) - sample = RtkSample( - index=len(samples), - source="dobject", - object_name=record.object_name, - dotnet_ticks=record.dotnet_ticks, - timestamp_iso_local=timestamp_iso, - unix_time_ns=unix_ns, - log_time=record.log_time, - record_id=record.log_record_id, - source_log=record.source_log, - source_dorec=record.source_dorec, - source_offset=record.source_offset, - payload_length=record.payload_length, - ) - try: - dorec_path = choose_dorec(dorec_index, record.source_dorec) - record_meta, payload = read_record(dorec_path, record) - sample.record_id = str(record_meta["record_id"]) - parsed = parse_rtk_binary_payload(payload) - sample.device_name = str(parsed["device_name"]) - sample.device_stamp_hex = str(parsed["device_stamp_hex"]) - sample.counter = int(parsed["counter"]) # type: ignore[arg-type] - sample.lat = float(parsed["lat"]) # type: ignore[arg-type] - sample.lon = float(parsed["lon"]) # type: ignore[arg-type] - sample.alt_m = float(parsed["alt_m"]) # type: ignore[arg-type] - sample.raw_heading_deg = float(parsed["raw_heading_deg"]) # type: ignore[arg-type] - sample.vehicle_heading_deg = float(parsed["vehicle_heading_deg"]) # type: ignore[arg-type] - sample.fix = int(parsed["fix"]) # type: ignore[arg-type] - sample.sat = int(parsed["sat"]) # type: ignore[arg-type] - sample.position_valid = bool(parsed["position_valid"]) - sample.heading_valid = bool(parsed["heading_valid"]) - sample.heading_solution = str(parsed["heading_solution"]) - sample.position_time = str(parsed["position_time"]) - sample.heading_time = str(parsed["heading_time"]) - sample.last_line = parsed["last_line"] # type: ignore[assignment] - sample.raw_text = json.dumps(parsed, ensure_ascii=False, separators=(",", ":")) - stats["parsed_ok"] += 1 - except Exception as exc: - sample.parse_error = f"{type(exc).__name__}: {exc}" - stats["parse_errors"] += 1 - samples.append(sample) - return samples, stats - - -def load_gps_post_samples( - root: Path, - dorec_index: dict[str, list[Path]], - tz: timezone, -) -> tuple[list[dict[str, object]], dict[str, int]]: - records = discover_records(root, "GPS-POST") - rows: list[dict[str, object]] = [] - stats = {"discovered": len(records), "parsed_ok": 0, "parse_errors": 0, "read_errors": 0} - for index, record in enumerate(records): - timestamp_iso, unix_ns = dotnet_ticks_to_values(record.dotnet_ticks, tz) - row: dict[str, object] = { - "index": index, - "object_name": record.object_name, - "dotnet_ticks": record.dotnet_ticks, - "timestamp_iso_local": timestamp_iso, - "unix_time_ns": unix_ns, - "log_time": record.log_time, - "record_id": record.log_record_id, - "source_log": record.source_log, - "source_dorec": record.source_dorec, - "source_offset": record.source_offset, - "payload_length": record.payload_length, - "parse_error": "", - } - try: - dorec_path = choose_dorec(dorec_index, record.source_dorec) - record_meta, payload = read_record(dorec_path, record) - row["record_id"] = record_meta["record_id"] - parsed = parse_gps_post_payload(payload) - row.update(parsed) - stats["parsed_ok"] += 1 - except Exception as exc: - row["parse_error"] = f"{type(exc).__name__}: {exc}" - stats["parse_errors"] += 1 - rows.append(row) - return rows, stats - - -def load_gps_post_z_text_logs(root: Path) -> tuple[list[dict[str, object]], dict[str, int]]: - rows: list[dict[str, object]] = [] - stats = {"files": 0, "lines": 0, "parsed_ok": 0, "parse_errors": 0} - text_root = root / "GPS-POST-Z" - if not text_root.is_dir(): - return rows, stats - for log_path in sorted(text_root.rglob("*.log")): - stats["files"] += 1 - relative = log_path.relative_to(root).as_posix() - with log_path.open("r", encoding="utf-8", errors="replace") as stream: - for line_no, line in enumerate(stream, start=1): - match = GPS_TEXT_RE.search(line) - if not match: - continue - stats["lines"] += 1 - body = match.group("body").strip() - row: dict[str, object] = { - "index": len(rows), - "source": "GPS-POST-Z-text-log", - "source_log": relative, - "line_no": line_no, - "log_time": match.group("log_time"), - "raw_text": body, - "parse_error": "", - } - try: - parsed = parse_gps_post_z_text(body) - row.update( - { - "lat": parsed["lat"], - "lon": parsed["lon"], - "alt_m": parsed["alt_m"], - "raw_heading_deg": parsed["raw_heading_deg"], - "vehicle_heading_deg": parsed["vehicle_heading_deg"], - "fix": parsed["fix"], - "sat": parsed["sat"], - "position_valid": parsed["position_valid"], - "heading_valid": parsed["heading_valid"], - "heading_solution": parsed["heading_solution"], - "position_time": parsed["position_time"], - "heading_time": parsed["heading_time"], - } - ) - stats["parsed_ok"] += 1 - except Exception as exc: - row["parse_error"] = f"{type(exc).__name__}: {exc}" - stats["parse_errors"] += 1 - rows.append(row) - return rows, stats - - -def match_rtk(unix_time_ns: int, samples: Sequence[RtkSample]) -> dict[str, object]: - if not samples: - return { - "matched": False, - "nearest_index": -1, - "prev_index": -1, - "next_index": -1, - "dt_ns": None, - "prev_dt_ns": None, - "next_dt_ns": None, - "sample": None, - } - ticks = [sample.unix_time_ns for sample in samples] - pos = bisect.bisect_left(ticks, unix_time_ns) - if pos < len(samples) and ticks[pos] == unix_time_ns: - nearest = prev_index = next_index = pos - else: - candidates: list[int] = [] - if pos < len(samples): - candidates.append(pos) - if pos > 0: - candidates.append(pos - 1) - nearest = min(candidates, key=lambda idx: (abs(ticks[idx] - unix_time_ns), idx)) - prev_index = pos - 1 if pos > 0 else -1 - next_index = pos if pos < len(samples) else -1 - sample = samples[nearest] - prev_dt = None if prev_index < 0 else unix_time_ns - samples[prev_index].unix_time_ns - next_dt = None if next_index < 0 else samples[next_index].unix_time_ns - unix_time_ns - return { - "matched": True, - "nearest_index": nearest, - "prev_index": prev_index, - "next_index": next_index, - "dt_ns": unix_time_ns - sample.unix_time_ns, - "prev_dt_ns": prev_dt, - "next_dt_ns": next_dt, - "sample": sample, - } - - -def rtk_frame_arrays(match: dict[str, object]) -> dict[str, tuple[str, Sequence[int], bytes]]: - sample: RtkSample | None = match["sample"] # type: ignore[assignment] - return { - "rtk_nearest_index": (" dict[str, object]: - rtk_dir = output / "rtk" - rtk_dir.mkdir(exist_ok=True) - written: dict[str, object] = {"directory": "rtk"} - - export_rtk_table_npz(rtk_dir / "gps_post_z.npz", gps_post_z, compress) - gps_dicts = [sample_to_public_dict(sample) for sample in gps_post_z] - write_jsonl(rtk_dir / "gps_post_z.jsonl", gps_dicts) - write_csv_rows( - rtk_dir / "gps_post_z.csv", - [ - "index", - "dotnet_ticks", - "timestamp_iso_local", - "unix_time_ns", - "log_time", - "record_id", - "counter", - "lat", - "lon", - "alt_m", - "raw_heading_deg", - "vehicle_heading_deg", - "fix", - "sat", - "position_valid", - "heading_valid", - "heading_solution", - "position_time", - "heading_time", - "last_line", - "source_log", - "source_dorec", - "source_offset", - "payload_length", - "parse_error", - "raw_text", - ], - gps_dicts, - ) - written["gps_post_z"] = { - "npz": "rtk/gps_post_z.npz", - "csv": "rtk/gps_post_z.csv", - "jsonl": "rtk/gps_post_z.jsonl", - "count": len(gps_post_z), - } - - export_rtk_table_npz(rtk_dir / "rtk_binary.npz", rtk_binary, compress) - rtk_dicts = [sample_to_public_dict(sample) for sample in rtk_binary] - write_jsonl(rtk_dir / "rtk_binary.jsonl", rtk_dicts) - write_csv_rows( - rtk_dir / "rtk_binary.csv", - [ - "index", - "dotnet_ticks", - "timestamp_iso_local", - "unix_time_ns", - "log_time", - "record_id", - "device_name", - "device_stamp_hex", - "counter", - "lat", - "lon", - "alt_m", - "raw_heading_deg", - "vehicle_heading_deg", - "fix", - "sat", - "position_valid", - "heading_valid", - "heading_solution", - "position_time", - "heading_time", - "last_line", - "source_log", - "source_dorec", - "source_offset", - "payload_length", - "parse_error", - ], - rtk_dicts, - ) - written["rtk_binary"] = { - "npz": "rtk/rtk_binary.npz", - "csv": "rtk/rtk_binary.csv", - "jsonl": "rtk/rtk_binary.jsonl", - "count": len(rtk_binary), - } - - write_jsonl(rtk_dir / "gps_post.jsonl", gps_post_rows) - write_csv_rows( - rtk_dir / "gps_post.csv", - [ - "index", - "dotnet_ticks", - "timestamp_iso_local", - "unix_time_ns", - "log_time", - "record_id", - "device_name", - "counter", - "unknown0", - "flags_hex", - "device_stamp_hex", - "source_log", - "source_dorec", - "source_offset", - "payload_length", - "payload_hex", - "parse_error", - ], - gps_post_rows, - ) - # Compact NPZ for GPS-POST counters / stamps only. - temp = (rtk_dir / "gps_post.npz").with_suffix(".npz.tmp") - with open_npz_writer(temp, compress) as archive: - n = len(gps_post_rows) - write_npy_entry( - archive, - "index", - " dict[str, object]: - abs_dts = [abs(value) for value in match_dts_ns] - abs_interior = [abs(value) for value in interior_dts_ns] - threshold_ns = rtk_max_dt_ms * 1_000_000.0 - over_threshold = sum(1 for value in abs_interior if value > threshold_ns) - checks: list[dict[str, object]] = [ - { - "name": "lidar_payload_length", - "ok": lidar_stats.get("frames_with_errors", 0) == 0, - "detail": "Each lidar payload must equal 8 + point_count * 20.", - }, - { - "name": "gps_post_z_parse", - "ok": gps_post_z_stats.get("parse_errors", 0) == 0 - and gps_post_z_stats.get("read_errors", 0) == 0, - "detail": "All GPS-POST-Z dobject payloads should parse.", - }, - { - "name": "lidar_rtk_coverage", - "ok": unmatched_frames == 0, - "detail": "Every exported lidar frame should have a nearest GPS-POST-Z sample.", - }, - { - "name": "rtk_time_alignment", - "ok": over_threshold == 0, - "detail": ( - f"Interior frames (with both prev/next RTK) should have nearest |dt| " - f"<= {rtk_max_dt_ms} ms." - ), - }, - ] - if rtk_sidecars: - checks.insert( - 2, - { - "name": "rtk_binary_parse", - "ok": rtk_binary_stats.get("parse_errors", 0) == 0, - "detail": "All rtk binary payloads should parse as UNICORE_N4_RTK_V1.", - }, - ) - report = { - "format_version": FORMAT_VERSION, - "generated_at": datetime.now().astimezone().isoformat(), - "lidar": lidar_stats, - "rtk_sidecars": rtk_sidecars, - "rtk_sources": { - "GPS-POST-Z_dobject": gps_post_z_stats, - "rtk_dobject": rtk_binary_stats if rtk_sidecars else {"skipped": True}, - "GPS-POST_dobject": gps_post_stats if rtk_sidecars else {"skipped": True}, - "GPS-POST-Z_text_log": text_stats if rtk_sidecars else {"skipped": True}, - }, - "matching": { - "primary_source": "GPS-POST-Z", - "matched_frames": matched_frames, - "unmatched_frames": unmatched_frames, - "edge_frames_outside_rtk_span": edge_frames, - "rtk_max_dt_ms_threshold": rtk_max_dt_ms, - "interior_frames_over_threshold": over_threshold, - "dt_ns": { - "count": len(abs_dts), - "min": min(match_dts_ns) if match_dts_ns else None, - "max": max(match_dts_ns) if match_dts_ns else None, - "abs_min": min(abs_dts) if abs_dts else None, - "abs_max": max(abs_dts) if abs_dts else None, - "abs_mean": (sum(abs_dts) / len(abs_dts)) if abs_dts else None, - }, - "interior_dt_ns": { - "count": len(abs_interior), - "abs_min": min(abs_interior) if abs_interior else None, - "abs_max": max(abs_interior) if abs_interior else None, - "abs_mean": (sum(abs_interior) / len(abs_interior)) if abs_interior else None, - }, - }, - "checks": checks, - } - report["ok"] = all(bool(check["ok"]) for check in checks) - return report - - -def write_package_readme( - path: Path, - *, - format_version: str, - frame_count: int, - include_rtk: bool, - timezone_text: str, -) -> None: - rtk_note = ( - "每帧 NPZ 已嵌入最近 RTK:`rtk_lat` / `rtk_lon` / `rtk_alt_m` / " - "`rtk_vehicle_heading_deg` / `rtk_fix` / `rtk_sat` 等。\n" - if include_rtk - else "本包未嵌入 RTK(导出时使用了 `--skip-rtk`)。\n" - ) - text = """# FrontLidar 数据集 - -格式版本:`@@FORMAT_VERSION@@` -帧数:`@@FRAME_COUNT@@` -时区:`@@TIMEZONE@@` - -## 目录 - -```text -. - README.md # 本说明 - frames/ # 逐帧 NPZ - frontlidar___frame.npz -``` - -直接打包本目录即可分发。 - -## 依赖 - -```powershell -pip install numpy -``` - -## 快速读取 - -```python -import json -from pathlib import Path -import numpy as np - -root = Path(__file__).resolve().parent # 或改成数据集路径 -frame_path = next(sorted((root / "frames").glob("*.npz"))) - -with np.load(frame_path, allow_pickle=False) as f: - points = f["points_raw"] # float32 (N, 5) - unix_ns = int(f["unix_time_ns"][0]) - meta = json.loads(f["metadata_json_utf8"].tobytes().decode("utf-8")) - - # 列: d_mm, azimuth_deg, altitude_deg, intensity, progression - d_mm, az, alt, intensity, prog = (points[:, i] for i in range(5)) - - # RTK(若导出时未 --skip-rtk) - if "rtk_lat" in f.files: - lat = float(f["rtk_lat"][0]) - lon = float(f["rtk_lon"][0]) - heading = float(f["rtk_vehicle_heading_deg"][0]) - dt_ms = int(f["rtk_dt_ns"][0]) / 1e6 - print(lat, lon, heading, dt_ms, meta.get("rtk", {}).get("heading_solution")) -``` - -@@RTK_NOTE@@ -## 点云列 - -| 列 | 字段 | 单位 | -|---:|---|---| -| 0 | d_mm | mm | -| 1 | azimuth_deg | ° | -| 2 | altitude_deg | ° | -| 3 | intensity | 设备定义 | -| 4 | progression | 0–1 | - -极坐标转传感器 XYZ(mm): - -```python -az = np.deg2rad(points[:, 1]) -alt = np.deg2rad(points[:, 2]) -d = points[:, 0] -xyz = np.column_stack(( - d * np.cos(alt) * np.cos(az), - d * np.cos(alt) * np.sin(az), - d * np.sin(alt), -)).astype(np.float32) -``` - -## 时间戳 - -- `dotnet_ticks`:原始权威时间 -- `unix_time_ns`:按导出时区转换的 Unix 纳秒 -- 标量字段均为 shape `(1,)`,用 `[0]` 取出 - -## 批量遍历 - -```python -for path in sorted((root / "frames").glob("*.npz")): - with np.load(path, allow_pickle=False) as f: - pts = f["points_raw"] - # ... -``` - -更多字段说明见导出仓库中的 `FRONTLIDAR_NPZ_READ.md`(若一并提供)。 -""" - text = ( - text.replace("@@FORMAT_VERSION@@", format_version) - .replace("@@FRAME_COUNT@@", str(frame_count)) - .replace("@@TIMEZONE@@", timezone_text) - .replace("@@RTK_NOTE@@", rtk_note) - ) - path.write_text(text, encoding="utf-8") - - -def export_dataset(args: argparse.Namespace) -> int: - started = time.time() - root = resolve_dlog_root(args.dlog) - output = Path(args.out).expanduser().resolve() - output.mkdir(parents=True, exist_ok=True) - frames_dir = output / "frames" - frames_dir.mkdir(exist_ok=True) - tz = parse_timezone(args.timezone) - records = discover_records(root, args.object) - selected = records[:: args.stride] - if args.max_frames: - selected = selected[: args.max_frames] - if not selected: - raise RuntimeError(f"no DObject records named {args.object!r} found under {root}") - dorec_index = index_dorec_files(root) - rotation = rotation_matrix(args.yaw, args.pitch, args.roll) - translation = (args.x, args.y, args.z) - extension = "npz" if args.format == "npz" else "pkl" - include_rtk = not args.skip_rtk - rtk_sidecars = bool(args.rtk_sidecars) - - gps_post_z: list[RtkSample] = [] - rtk_binary: list[RtkSample] = [] - gps_post_rows: list[dict[str, object]] = [] - text_rows: list[dict[str, object]] = [] - gps_post_z_stats = {"discovered": 0, "parsed_ok": 0, "parse_errors": 0, "read_errors": 0} - rtk_binary_stats = {"discovered": 0, "parsed_ok": 0, "parse_errors": 0, "read_errors": 0} - gps_post_stats = {"discovered": 0, "parsed_ok": 0, "parse_errors": 0, "read_errors": 0} - text_stats = {"files": 0, "lines": 0, "parsed_ok": 0, "parse_errors": 0} - rtk_outputs: dict[str, object] = {} - - if include_rtk: - print("Loading GPS-POST-Z for per-frame RTK matching...", flush=True) - gps_post_z, gps_post_z_stats = load_gps_post_z_samples(root, dorec_index, tz, args.timezone) - if rtk_sidecars: - print("Loading RTK sidecars...", flush=True) - rtk_binary, rtk_binary_stats = load_rtk_binary_samples(root, dorec_index, tz) - gps_post_rows, gps_post_stats = load_gps_post_samples(root, dorec_index, tz) - text_rows, text_stats = load_gps_post_z_text_logs(root) - rtk_outputs = export_rtk_sidecars( - output, - bool(args.compress and args.format == "npz"), - gps_post_z, - rtk_binary, - gps_post_rows, - text_rows, - ) - print( - f"RTK loaded: GPS-POST-Z={len(gps_post_z)} rtk={len(rtk_binary)} " - f"GPS-POST={len(gps_post_rows)} text={len(text_rows)} (sidecars on)", - flush=True, - ) - else: - print( - f"RTK loaded: GPS-POST-Z={len(gps_post_z)} (sidecars off; use --rtk-sidecars to write rtk/)", - flush=True, - ) - - write_reports = bool(args.write_reports) - reports_dir = output / "reports" - if write_reports: - reports_dir.mkdir(exist_ok=True) - manifest_tmp = reports_dir / "manifest.partial.csv" - manifest_final = reports_dir / "manifest.csv" - match_tmp = reports_dir / "rtk_match.partial.csv" - match_final = reports_dir / "rtk_match.csv" - manifest_stream_cm: object = manifest_tmp.open("w", newline="", encoding="utf-8-sig") - match_stream = ( - match_tmp.open("w", newline="", encoding="utf-8-sig") if include_rtk else None - ) - else: - manifest_tmp = manifest_final = match_tmp = match_final = None - manifest_stream_cm = nullcontext(io.StringIO()) - match_stream = io.StringIO() if include_rtk else None - - exported = skipped = resumed = total_points = 0 - matched_frames = unmatched_frames = edge_frames = 0 - match_dts_ns: list[int] = [] - interior_dts_ns: list[int] = [] - match_fieldnames = [ - "sequence", - "lidar_unix_time_ns", - "lidar_dotnet_ticks", - "output_file", - "rtk_matched", - "rtk_nearest_index", - "rtk_prev_index", - "rtk_next_index", - "rtk_dt_ns", - "rtk_prev_dt_ns", - "rtk_next_dt_ns", - "rtk_dotnet_ticks", - "rtk_unix_time_ns", - "rtk_lat", - "rtk_lon", - "rtk_alt_m", - "rtk_raw_heading_deg", - "rtk_vehicle_heading_deg", - "rtk_fix", - "rtk_sat", - "rtk_position_valid", - "rtk_heading_valid", - "rtk_heading_solution", - "rtk_position_time", - "rtk_heading_time", - "rtk_last_line", - "rtk_source_dorec", - "rtk_source_offset", - ] - - match_writer = csv.DictWriter(match_stream, fieldnames=match_fieldnames) if match_stream else None - if match_writer: - match_writer.writeheader() - - with manifest_stream_cm as manifest_stream: - writer = csv.DictWriter(manifest_stream, fieldnames=manifest_fields(include_rtk)) - writer.writeheader() - for selected_index, record in enumerate(selected): - row: dict[str, object] = { - "sequence": record.sequence, - "status": "error", - "object_name": record.object_name, - "dotnet_ticks": record.dotnet_ticks, - "timestamp_iso_local": "", - "unix_time_ns": "", - "log_time": record.log_time, - "record_id": record.log_record_id, - "record_id_bytes_hex": "", - "frame_counter": "", - "point_count": "", - "payload_length": record.payload_length, - "source_log": record.source_log, - "source_dorec": record.source_dorec, - "source_offset": record.source_offset, - "output_file": "", - "error": "", - } - if include_rtk: - row.update( - { - "rtk_matched": False, - "rtk_nearest_index": -1, - "rtk_prev_index": -1, - "rtk_next_index": -1, - "rtk_dt_ns": "", - "rtk_prev_dt_ns": "", - "rtk_next_dt_ns": "", - "rtk_lat": "", - "rtk_lon": "", - "rtk_alt_m": "", - "rtk_vehicle_heading_deg": "", - "rtk_raw_heading_deg": "", - "rtk_fix": "", - "rtk_sat": "", - "rtk_position_valid": "", - "rtk_heading_valid": "", - "rtk_heading_solution": "", - } - ) - try: - dorec_path = choose_dorec(dorec_index, record.source_dorec) - record_meta, payload = read_record(dorec_path, record) - frame_counter, point_count, raw_points = parse_lidar_payload(payload) - timestamp_iso, unix_ns = dotnet_ticks_to_values(record.dotnet_ticks, tz) - filename = frame_filename(record, frame_counter, extension) - relative_output = (Path("frames") / filename).as_posix() - frame_path = output / relative_output - metadata: dict[str, object] = { - "format_version": FORMAT_VERSION, - "sequence": record.sequence, - "object_name": record.object_name, - "dotnet_ticks": record.dotnet_ticks, - "timestamp_iso_local": timestamp_iso, - "unix_time_ns": unix_ns, - "timezone": args.timezone, - "log_time": record.log_time, - "record_id": record_meta["record_id"], - "record_id_bytes_hex": record_meta["record_id_bytes_hex"], - "frame_counter": frame_counter, - "point_count": point_count, - "payload_length": record_meta["payload_length"], - "source_log": record.source_log, - "source_dorec": record.source_dorec, - "source_offset": record.source_offset, - "point_columns": ["d_mm", "azimuth_deg", "altitude_deg", "intensity", "progression"], - "extrinsic": { - "translation_mm": list(translation), - "yaw_pitch_roll_deg": [args.yaw, args.pitch, args.roll], - "rotation_row_major": list(rotation), - }, - } - rtk_arrays = None - match_info: dict[str, object] | None = None - if include_rtk: - match_info = match_rtk(unix_ns, gps_post_z) - sample: RtkSample | None = match_info["sample"] # type: ignore[assignment] - if match_info["matched"]: - matched_frames += 1 - dt_ns = int(match_info["dt_ns"]) - match_dts_ns.append(dt_ns) - prev_i = int(match_info["prev_index"]) - next_i = int(match_info["next_index"]) - if prev_i < 0 or next_i < 0: - edge_frames += 1 - else: - interior_dts_ns.append(dt_ns) - else: - unmatched_frames += 1 - rtk_meta = { - "matched": bool(match_info["matched"]), - "nearest_index": match_info["nearest_index"], - "prev_index": match_info["prev_index"], - "next_index": match_info["next_index"], - "dt_ns": match_info["dt_ns"], - "prev_dt_ns": match_info["prev_dt_ns"], - "next_dt_ns": match_info["next_dt_ns"], - "primary_source": "GPS-POST-Z", - } - if sample is not None: - rtk_meta.update( - { - "dotnet_ticks": sample.dotnet_ticks, - "unix_time_ns": sample.unix_time_ns, - "timestamp_iso_local": sample.timestamp_iso_local, - "lat": sample.lat, - "lon": sample.lon, - "alt_m": sample.alt_m, - "raw_heading_deg": sample.raw_heading_deg, - "vehicle_heading_deg": sample.vehicle_heading_deg, - "fix": sample.fix, - "sat": sample.sat, - "position_valid": sample.position_valid, - "heading_valid": sample.heading_valid, - "heading_solution": sample.heading_solution, - "position_time": sample.position_time, - "heading_time": sample.heading_time, - "last_line": sample.last_line, - "counter": sample.counter, - "record_id": sample.record_id, - "source_dorec": sample.source_dorec, - "source_offset": sample.source_offset, - } - ) - metadata["rtk"] = rtk_meta - rtk_arrays = rtk_frame_arrays(match_info) - row.update( - { - "rtk_matched": bool(match_info["matched"]), - "rtk_nearest_index": match_info["nearest_index"], - "rtk_prev_index": match_info["prev_index"], - "rtk_next_index": match_info["next_index"], - "rtk_dt_ns": "" if match_info["dt_ns"] is None else match_info["dt_ns"], - "rtk_prev_dt_ns": "" if match_info["prev_dt_ns"] is None else match_info["prev_dt_ns"], - "rtk_next_dt_ns": "" if match_info["next_dt_ns"] is None else match_info["next_dt_ns"], - "rtk_lat": "" if sample is None or sample.lat is None else sample.lat, - "rtk_lon": "" if sample is None or sample.lon is None else sample.lon, - "rtk_alt_m": "" if sample is None or sample.alt_m is None else sample.alt_m, - "rtk_vehicle_heading_deg": ( - "" if sample is None or sample.vehicle_heading_deg is None else sample.vehicle_heading_deg - ), - "rtk_raw_heading_deg": ( - "" if sample is None or sample.raw_heading_deg is None else sample.raw_heading_deg - ), - "rtk_fix": "" if sample is None or sample.fix is None else sample.fix, - "rtk_sat": "" if sample is None or sample.sat is None else sample.sat, - "rtk_position_valid": "" if sample is None else sample.position_valid, - "rtk_heading_valid": "" if sample is None else sample.heading_valid, - "rtk_heading_solution": "" if sample is None else sample.heading_solution, - } - ) - if match_writer is not None: - match_writer.writerow( - { - "sequence": record.sequence, - "lidar_unix_time_ns": unix_ns, - "lidar_dotnet_ticks": record.dotnet_ticks, - "output_file": relative_output, - "rtk_matched": bool(match_info["matched"]), - "rtk_nearest_index": match_info["nearest_index"], - "rtk_prev_index": match_info["prev_index"], - "rtk_next_index": match_info["next_index"], - "rtk_dt_ns": "" if match_info["dt_ns"] is None else match_info["dt_ns"], - "rtk_prev_dt_ns": "" if match_info["prev_dt_ns"] is None else match_info["prev_dt_ns"], - "rtk_next_dt_ns": "" if match_info["next_dt_ns"] is None else match_info["next_dt_ns"], - "rtk_dotnet_ticks": "" if sample is None else sample.dotnet_ticks, - "rtk_unix_time_ns": "" if sample is None else sample.unix_time_ns, - "rtk_lat": "" if sample is None else sample.lat, - "rtk_lon": "" if sample is None else sample.lon, - "rtk_alt_m": "" if sample is None else sample.alt_m, - "rtk_raw_heading_deg": "" if sample is None else sample.raw_heading_deg, - "rtk_vehicle_heading_deg": "" if sample is None else sample.vehicle_heading_deg, - "rtk_fix": "" if sample is None else sample.fix, - "rtk_sat": "" if sample is None else sample.sat, - "rtk_position_valid": "" if sample is None else sample.position_valid, - "rtk_heading_valid": "" if sample is None else sample.heading_valid, - "rtk_heading_solution": "" if sample is None else sample.heading_solution, - "rtk_position_time": "" if sample is None else sample.position_time, - "rtk_heading_time": "" if sample is None else sample.heading_time, - "rtk_last_line": "" if sample is None else sample.last_line, - "rtk_source_dorec": "" if sample is None else sample.source_dorec, - "rtk_source_offset": "" if sample is None else sample.source_offset, - } - ) - - row.update( - { - "timestamp_iso_local": timestamp_iso, - "unix_time_ns": unix_ns, - "record_id": record_meta["record_id"], - "record_id_bytes_hex": record_meta["record_id_bytes_hex"], - "frame_counter": frame_counter, - "point_count": point_count, - "output_file": relative_output, - } - ) - if args.resume and frame_path.exists(): - row["status"] = "resumed" - resumed += 1 - else: - xyz_sensor, xyz_cart = generate_xyz(raw_points, args.include_xyz, translation, rotation) - if args.format == "npz": - export_npz( - frame_path, - metadata, - raw_points, - point_count, - xyz_sensor, - xyz_cart, - args.compress, - rtk_arrays=rtk_arrays, - ) - else: - export_pickle(frame_path, metadata, raw_points, point_count, xyz_sensor, xyz_cart) - row["status"] = "exported" - exported += 1 - total_points += point_count - except Exception as exc: - skipped += 1 - row["error"] = f"{type(exc).__name__}: {exc}" - writer.writerow(row) - if (selected_index + 1) % 25 == 0 or selected_index + 1 == len(selected): - manifest_stream.flush() - if match_stream is not None: - match_stream.flush() - print( - f"[{selected_index + 1}/{len(selected)}] exported={exported} resumed={resumed} " - f"errors={skipped} points={total_points}", - flush=True, - ) - - if match_stream is not None: - match_stream.close() - if write_reports and match_tmp is not None and match_final is not None: - os.replace(match_tmp, match_final) - if write_reports and manifest_tmp is not None and manifest_final is not None: - os.replace(manifest_tmp, manifest_final) - - lidar_stats = { - "records_discovered": len(records), - "records_selected": len(selected), - "frames_exported": exported, - "frames_resumed": resumed, - "frames_with_errors": skipped, - "total_points_in_manifest": total_points, - } - validation = build_validation_report( - lidar_stats=lidar_stats, - gps_post_z_stats=gps_post_z_stats, - rtk_binary_stats=rtk_binary_stats, - gps_post_stats=gps_post_stats, - text_stats=text_stats, - match_dts_ns=match_dts_ns, - interior_dts_ns=interior_dts_ns, - edge_frames=edge_frames, - matched_frames=matched_frames, - unmatched_frames=unmatched_frames, - rtk_max_dt_ms=args.rtk_max_dt_ms, - rtk_sidecars=rtk_sidecars, - ) - - write_package_readme( - output / "README.md", - format_version=FORMAT_VERSION, - frame_count=exported + resumed, - include_rtk=include_rtk, - timezone_text=args.timezone, - ) - - metadata = { - "format_version": FORMAT_VERSION, - "generated_at": datetime.now().astimezone().isoformat(), - "source_dlog": str(root), - "object_name": args.object, - "output_format": args.format, - "npz_compressed": bool(args.compress and args.format == "npz"), - "include_xyz": args.include_xyz, - "include_rtk": include_rtk, - "rtk_sidecars": rtk_sidecars, - "write_reports": write_reports, - "timezone": args.timezone, - "timezone_offset_minutes": timezone_minutes(tz), - "rtk_max_dt_ms": args.rtk_max_dt_ms, - "rtk_objects": list(RTK_OBJECT_NAMES), - "rtk_outputs": rtk_outputs if rtk_sidecars else None, - "package_contents": ["README.md", "frames/"] - + (["rtk/"] if rtk_sidecars else []) - + (["reports/"] if write_reports else []), - **lidar_stats, - "point_columns": [ - {"name": "d_mm", "dtype": "float32", "unit": "mm"}, - {"name": "azimuth_deg", "dtype": "float32", "unit": "degree"}, - {"name": "altitude_deg", "dtype": "float32", "unit": "degree"}, - {"name": "intensity", "dtype": "float32", "unit": "device-specific"}, - {"name": "progression", "dtype": "float32", "unit": "scan fraction"}, - ], - "extrinsic": { - "translation_mm": list(translation), - "yaw_pitch_roll_deg": [args.yaw, args.pitch, args.roll], - "rotation_row_major": list(rotation), - }, - "validation_ok": validation["ok"], - "duration_seconds": round(time.time() - started, 3), - } - if write_reports: - with (reports_dir / "metadata.json").open("w", encoding="utf-8") as stream: - json.dump(metadata, stream, ensure_ascii=False, indent=2) - stream.write("\n") - with (reports_dir / "validation_report.json").open("w", encoding="utf-8") as stream: - json.dump(validation, stream, ensure_ascii=False, indent=2) - stream.write("\n") - - print(json.dumps(metadata, ensure_ascii=False, indent=2), flush=True) - print( - json.dumps( - {"validation_ok": validation["ok"], "checks": validation["checks"]}, - ensure_ascii=False, - indent=2, - ), - flush=True, - ) - if skipped != 0: - return 1 - if include_rtk and not validation["ok"]: - return 1 - return 0 - - -def main() -> int: - try: - return export_dataset(parse_args()) - except Exception as exc: - print(f"ERROR: {type(exc).__name__}: {exc}", file=sys.stderr) - return 2 - - -if __name__ == "__main__": - raise SystemExit(main()) diff --git a/LiDAR_RTK_Direct_Calibration/tools/prepare_multisensor_station_dataset.py b/LiDAR_RTK_Direct_Calibration/tools/prepare_multisensor_station_dataset.py deleted file mode 100644 index c47fdc5..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/prepare_multisensor_station_dataset.py +++ /dev/null @@ -1,170 +0,0 @@ -#!/usr/bin/env python3 -"""Prepare one static LiDAR frame and one yaw-only RTK reference pose per NPZ segment.""" - -from __future__ import annotations - -import argparse -import csv -import json -import math -import re -import shutil -from pathlib import Path -from typing import Any - -import numpy as np - -POSE_FIELDS = ["time", "x", "y", "z", "qx", "qy", "qz", "qw"] - - -def natural_key(value: str) -> list[Any]: - return [int(part) if part.isdigit() else part.lower() for part in re.split(r"(\d+)", value)] - - -def truth(value: Any) -> bool: - return str(value).strip().lower() in {"1", "true", "yes", "y"} - - -def circular_mean_deg(values: np.ndarray) -> float: - radians = np.deg2rad(values) - return float(np.rad2deg(math.atan2(np.mean(np.sin(radians)), np.mean(np.cos(radians)))) % 360.0) - - -def circular_std_deg(values: np.ndarray) -> float: - radians = np.deg2rad(values) - resultant = max(math.hypot(np.mean(np.cos(radians)), np.mean(np.sin(radians))), 1e-12) - return float(np.rad2deg(math.sqrt(-2.0 * math.log(resultant)))) - - -def geodetic_to_ecef(lat_deg: float, lon_deg: float, height_m: float) -> np.ndarray: - a, e2 = 6378137.0, 6.69437999014e-3 - lat, lon = math.radians(lat_deg), math.radians(lon_deg) - sin_lat, cos_lat, sin_lon, cos_lon = math.sin(lat), math.cos(lat), math.sin(lon), math.cos(lon) - n = a / math.sqrt(1.0 - e2 * sin_lat * sin_lat) - return np.array([(n + height_m) * cos_lat * cos_lon, (n + height_m) * cos_lat * sin_lon, - (n * (1.0 - e2) + height_m) * sin_lat], dtype=float) - - -def ecef_to_enu(ecef: np.ndarray, origin: np.ndarray, lat_deg: float, lon_deg: float) -> np.ndarray: - lat, lon = math.radians(lat_deg), math.radians(lon_deg) - slat, clat, slon, clon = math.sin(lat), math.cos(lat), math.sin(lon), math.cos(lon) - rotation = np.array([[-slon, clon, 0.0], [-slat * clon, -slat * slon, clat], - [clat * clon, clat * slon, slat]], dtype=float) - return rotation @ (ecef - origin) - - -def yaw_rotation(yaw: float) -> np.ndarray: - c, s = math.cos(yaw), math.sin(yaw) - return np.array([[c, -s, 0.0], [s, c, 0.0], [0.0, 0.0, 1.0]]) - - -def scalar(data: np.lib.npyio.NpzFile, name: str) -> float: - return float(np.asarray(data[name]).reshape(-1)[0]) - - -def parse_args() -> argparse.Namespace: - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--combined-root", type=Path, required=True) - parser.add_argument("--output", type=Path, required=True) - parser.add_argument("--pose-name", default="rtk_gga_raw_heading") - parser.add_argument("--heading-offset-deg", type=float, required=True) - parser.add_argument("--antenna-lever", type=float, nargs=3, required=True, metavar=("X", "Y", "Z")) - parser.add_argument("--accepted-fixes", type=int, nargs="+", default=[4, 5]) - parser.add_argument("--heading-std-limit-deg", type=float, default=0.5) - parser.add_argument("--min-stations", type=int, default=30) - parser.add_argument("--expected-stations", type=int, default=0) - parser.add_argument("--overwrite", action="store_true") - return parser.parse_args() - - -def main() -> int: - args = parse_args() - manifest_path = args.combined_root / "manifest.csv" - with manifest_path.open("r", encoding="utf-8-sig", newline="") as stream: - rows = list(csv.DictReader(stream)) - required = {"segment", "output", "lidar_time_ns", "rtk_valid", "heading_valid", "rtk_fix_quality"} - if not rows or not required.issubset(rows[0]): - raise ValueError(f"{manifest_path} is empty or lacks {sorted(required)}") - groups: dict[str, list[dict[str, str]]] = {} - for row in rows: - groups.setdefault(row["segment"], []).append(row) - - selected, summaries, rejected = [], [], [] - accepted_fixes = set(args.accepted_fixes) - for segment in sorted(groups, key=natural_key): - group = sorted(groups[segment], key=lambda row: int(row["lidar_time_ns"])) - good = [row for row in group if truth(row["rtk_valid"]) and truth(row["heading_valid"]) - and int(row["rtk_fix_quality"]) in accepted_fixes] - if not good: - rejected.append({"station": segment, "reason": "no associated fixed RTK position and valid heading"}) - continue - samples = [] - for row in good: - path = args.combined_root / Path(row["output"]) - with np.load(path, allow_pickle=False) as data: - samples.append((scalar(data, "rtk_lat_deg"), scalar(data, "rtk_lon_deg"), - scalar(data, "rtk_altitude_m"), scalar(data, "rtk_raw_heading_deg"), - scalar(data, "rtk_pitch_deg"), scalar(data, "rtk_heading_stddev_deg"))) - values = np.asarray(samples, dtype=float) - heading_std = circular_std_deg(values[:, 3]) - if heading_std > args.heading_std_limit_deg: - rejected.append({"station": segment, "reason": f"heading std {heading_std:.4f} deg exceeds limit"}) - continue - frame = good[len(good) // 2] - source = args.combined_root / Path(frame["output"]) - selected.append({"station": segment, "source": source, "time": int(frame["lidar_time_ns"]) / 1e9, - "lat": float(np.mean(values[:, 0])), "lon": float(np.mean(values[:, 1])), - "alt": float(np.mean(values[:, 2])), "heading": circular_mean_deg(values[:, 3])}) - summaries.append({"station": segment, "frames": len(group), "valid_fixed_frames": len(good), - "heading_mean_deg": circular_mean_deg(values[:, 3]), - "heading_circular_std_deg": heading_std, "rtk_pitch_mean_deg": float(np.mean(values[:, 4])), - "reported_heading_std_mean_deg": float(np.nanmean(values[:, 5])), - "altitude_std_m": float(np.std(values[:, 2])), "selected_source": str(source)}) - - if args.expected_stations and len(selected) != args.expected_stations: - raise RuntimeError(f"expected {args.expected_stations} usable stations, got {len(selected)}; rejected={rejected}") - if len(selected) < args.min_stations: - raise RuntimeError(f"need at least {args.min_stations} usable stations, got {len(selected)}; rejected={rejected}") - if args.output.exists() and any(args.output.iterdir()) and not args.overwrite: - raise FileExistsError(f"{args.output} is non-empty; pass --overwrite") - frames = args.output / "frames_all" - frames.mkdir(parents=True, exist_ok=True) - origin = selected[0] - origin_ecef = geodetic_to_ecef(origin["lat"], origin["lon"], origin["alt"]) - lever = np.asarray(args.antenna_lever, dtype=float) - pose_rows = [] - for index, item in enumerate(selected, 1): - destination = frames / f"station_{index:02d}.npz" - shutil.copy2(item["source"], destination) - antenna = ecef_to_enu(geodetic_to_ecef(item["lat"], item["lon"], item["alt"]), origin_ecef, - origin["lat"], origin["lon"]) - corrected_heading = (item["heading"] + args.heading_offset_deg) % 360.0 - yaw = math.radians(90.0 - corrected_heading) - reference_position = antenna - yaw_rotation(yaw) @ lever - pose_rows.append(dict(zip(POSE_FIELDS, [item["time"], *reference_position, 0.0, 0.0, - math.sin(yaw / 2.0), math.cos(yaw / 2.0)]))) - summaries[index - 1].update({"sequence": index, "prepared_frame": destination.name, - "corrected_heading_deg": corrected_heading}) - pose_path = args.output / f"reference_poses_{args.pose_name}.csv" - with pose_path.open("w", encoding="utf-8", newline="") as stream: - writer = csv.DictWriter(stream, fieldnames=POSE_FIELDS); writer.writeheader(); writer.writerows(pose_rows) - with (args.output / "station_summary.csv").open("w", encoding="utf-8", newline="") as stream: - fields = sorted({key for row in summaries for key in row}) - writer = csv.DictWriter(stream, fieldnames=fields); writer.writeheader(); writer.writerows(summaries) - document = {"source_combined_root": str(args.combined_root.resolve()), "station_count": len(selected), - "rejected": rejected, "pose_csv": pose_path.name, - "selection_policy": "middle LiDAR frame among fixed-position and valid-heading associations", - "reference_pose_configuration": {"raw_heading_offset_deg": args.heading_offset_deg, - "antenna_lever_body_m": args.antenna_lever, - "orientation_model": "yaw-only, identical to the previous calibration workflow"}, - "stations": [{"sequence": i + 1, "source_station": item["station"], - "source_frame": str(item["source"]), "prepared_frame": f"station_{i + 1:02d}.npz"} - for i, item in enumerate(selected)]} - (args.output / "manifest.json").write_text(json.dumps(document, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps({"prepared": str(args.output.resolve()), "stations": len(selected), - "rejected": rejected, "pose_csv": pose_path.name}, ensure_ascii=False, indent=2)) - return 0 - - -if __name__ == "__main__": - raise SystemExit(main()) diff --git a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/audit_capture_v2.py b/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/audit_capture_v2.py deleted file mode 100644 index 4d8bb77..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/audit_capture_v2.py +++ /dev/null @@ -1,22 +0,0 @@ -from __future__ import annotations - -import argparse -from pathlib import Path - -from capture_format_v2 import file_summary, read_capture -from pipeline_common import write_json - - -def main() -> None: - parser = argparse.ArgumentParser() - parser.add_argument("captures", nargs="+", type=Path) - parser.add_argument("--out", type=Path, required=True) - args = parser.parse_args() - summaries = [file_summary(read_capture(path)) for path in args.captures] - write_json(args.out, {"captures": summaries}) - for summary in summaries: - print(summary) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/capture_format_v2.py b/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/capture_format_v2.py deleted file mode 100644 index 3812980..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/capture_format_v2.py +++ /dev/null @@ -1,254 +0,0 @@ -from __future__ import annotations - -import binascii -import io -import struct -from dataclasses import dataclass, asdict -from pathlib import Path -from typing import BinaryIO, Iterator - - -FILE_MAGIC = "RAW_SERIAL_CAPTURE_FILE_V2" -RECORD_MAGIC = "RAW_SERIAL_RECORD_V2" -FOOTER_MAGIC = "RAW_SERIAL_CAPTURE_FOOTER_V2" - - -def read_7bit_int(stream: BinaryIO) -> int: - value = 0 - shift = 0 - while True: - raw = stream.read(1) - if not raw: - raise EOFError("truncated .NET string length") - value |= (raw[0] & 0x7F) << shift - if not raw[0] & 0x80: - return value - shift += 7 - if shift > 35: - raise ValueError("invalid .NET string length") - - -def read_dotnet_string(stream: BinaryIO) -> str: - length = read_7bit_int(stream) - raw = stream.read(length) - if len(raw) != length: - raise EOFError("truncated .NET string") - return raw.decode("utf-8") - - -def read_i32(stream: BinaryIO) -> int: - raw = stream.read(4) - if len(raw) != 4: - raise EOFError("truncated int32") - return struct.unpack(" int: - raw = stream.read(8) - if len(raw) != 8: - raise EOFError("truncated int64") - return struct.unpack(" int: - raw = stream.read(4) - if len(raw) != 4: - raise EOFError("truncated uint32") - return struct.unpack(" CaptureHeader: - if read_dotnet_string(stream) != FILE_MAGIC: - raise ValueError("not a V2 raw capture file") - version = read_i32(stream) - if version != 2: - raise ValueError(f"unsupported capture version: {version}") - return CaptureHeader( - sensor_kind=read_dotnet_string(stream), - session_id=read_dotnet_string(stream), - session_start_utc_ticks=read_i64(stream), - session_start_monotonic_ticks=read_i64(stream), - monotonic_frequency=read_i64(stream), - port=read_dotnet_string(stream), - baud=read_i32(stream), - file_start_utc_ticks=read_i64(stream), - ) - - -def parse_record_body(body: bytes, record_file_offset: int, record_crc: int) -> RawChunk: - stream = io.BytesIO(body) - if read_dotnet_string(stream) != RECORD_MAGIC: - raise ValueError("invalid record magic") - sequence = read_i64(stream) - receive_utc_ticks = read_i64(stream) - receive_monotonic_ticks = read_i64(stream) - raw_length = read_i32(stream) - if raw_length < 0 or raw_length > 64 * 1024 * 1024: - raise ValueError(f"invalid raw length: {raw_length}") - raw_offset = record_file_offset + 4 + stream.tell() - raw = stream.read(raw_length) - if len(raw) != raw_length: - raise EOFError("truncated raw bytes") - crc_valid = (binascii.crc32(body) & 0xFFFFFFFF) == record_crc - return RawChunk( - sequence=sequence, - receive_utc_ticks=receive_utc_ticks, - receive_monotonic_ticks=receive_monotonic_ticks, - raw=raw, - record_file_offset=record_file_offset, - raw_file_offset=raw_offset, - record_crc32=record_crc, - crc_valid=crc_valid, - ) - - -def parse_footer(body: bytes, expected_crc: int) -> CaptureFooter: - stream = io.BytesIO(body) - if read_dotnet_string(stream) != FOOTER_MAGIC: - raise ValueError("invalid footer magic") - clean_close = stream.read(1) == b"\x01" - records = read_i64(stream) - raw_bytes = read_i64(stream) - first_sequence = read_i64(stream) - last_sequence = read_i64(stream) - dropped_chunks = read_i64(stream) - dropped_bytes = read_i64(stream) - return CaptureFooter( - clean_close=clean_close, - records=records, - bytes=raw_bytes, - first_sequence=first_sequence, - last_sequence=last_sequence, - dropped_chunks=dropped_chunks, - dropped_bytes=dropped_bytes, - crc_valid=(binascii.crc32(body) & 0xFFFFFFFF) == expected_crc, - ) - - -def read_capture(path: Path) -> CaptureFile: - chunks: list[RawChunk] = [] - footer = None - truncated = False - with path.open("rb") as stream: - header = read_header(stream) - while True: - record_offset = stream.tell() - length_raw = stream.read(4) - if not length_raw: - break - if len(length_raw) != 4: - truncated = True - break - length = struct.unpack(" 1024 * 1024: - raise ValueError("invalid footer length") - footer_body = stream.read(footer_length) - if len(footer_body) != footer_length: - raise EOFError("truncated footer") - footer = parse_footer(footer_body, read_u32(stream)) - break - if length <= 0 or length > 64 * 1024 * 1024: - raise ValueError("invalid record length") - body = stream.read(length) - if len(body) != length: - raise EOFError("truncated record body") - record_crc = read_u32(stream) - chunks.append(parse_record_body(body, record_offset, record_crc)) - except (EOFError, ValueError): - truncated = True - break - return CaptureFile(str(path), header, chunks, footer, truncated) - - -def sequence_gaps(chunks: list[RawChunk]) -> list[tuple[int, int, int]]: - result = [] - for previous, current in zip(chunks, chunks[1:]): - if current.sequence > previous.sequence + 1: - result.append((previous.sequence, current.sequence, current.sequence - previous.sequence - 1)) - return result - - -def file_summary(capture: CaptureFile) -> dict: - gaps = sequence_gaps(capture.chunks) - sequences = [chunk.sequence for chunk in capture.chunks] - return { - "path": capture.path, - "sensor": capture.header.sensor_kind, - "session_id": capture.header.session_id, - "port": capture.header.port, - "baud": capture.header.baud, - "chunks_read": len(capture.chunks), - "bytes_read": sum(len(chunk.raw) for chunk in capture.chunks), - "first_sequence": sequences[0] if sequences else None, - "last_sequence": sequences[-1] if sequences else None, - "missing_chunks": sum(gap[2] for gap in gaps), - "gap_count": len(gaps), - "bad_record_crc": sum(not chunk.crc_valid for chunk in capture.chunks), - "truncated_tail": capture.truncated_tail, - "footer": None if capture.footer is None else asdict(capture.footer), - "gaps": gaps[:100], - } - - -def iter_contiguous_segments(chunks: list[RawChunk]) -> Iterator[tuple[int, list[RawChunk]]]: - if not chunks: - return - segment_id = 0 - current = [chunks[0]] - for previous, chunk in zip(chunks, chunks[1:]): - if chunk.sequence != previous.sequence + 1: - yield segment_id, current - segment_id += 1 - current = [chunk] - else: - current.append(chunk) - yield segment_id, current - diff --git a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/parse_rtk_imu_v2.py b/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/parse_rtk_imu_v2.py deleted file mode 100644 index d30a115..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/parse_rtk_imu_v2.py +++ /dev/null @@ -1,35 +0,0 @@ -from __future__ import annotations - -import argparse -from pathlib import Path - -from capture_format_v2 import file_summary, read_capture -from pipeline_common_corrected import parse_imu_capture, parse_rtk_capture, write_json, write_jsonl - - -def main() -> None: - parser = argparse.ArgumentParser() - parser.add_argument("--rtk", type=Path, required=True) - parser.add_argument("--imu", type=Path, required=True) - parser.add_argument("--out", type=Path, required=True) - args = parser.parse_args() - args.out.mkdir(parents=True, exist_ok=True) - rtk_capture = read_capture(args.rtk) - imu_capture = read_capture(args.imu) - rtk_rows = parse_rtk_capture(rtk_capture) - imu_rows = parse_imu_capture(imu_capture) - write_jsonl(args.out / "rtk.jsonl", rtk_rows) - write_jsonl(args.out / "imu.jsonl", imu_rows) - write_json(args.out / "parse_summary.json", { - "rtk_capture": file_summary(rtk_capture), - "imu_capture": file_summary(imu_capture), - "rtk_records": len(rtk_rows), - "rtk_checksum_valid": sum(bool(row.get("checksum_valid")) for row in rtk_rows), - "imu_frames": len(imu_rows), - "imu_crc_valid": sum(bool(row.get("crc_valid")) for row in imu_rows), - }) - print(f"RTK records={len(rtk_rows)}, IMU frames={len(imu_rows)}") - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common.py b/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common.py deleted file mode 100644 index 3f733ce..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common.py +++ /dev/null @@ -1,300 +0,0 @@ -from __future__ import annotations - -import binascii -import json -import math -import struct -from pathlib import Path -from typing import Iterable - -from capture_format_v2 import CaptureFile, RawChunk, iter_contiguous_segments, read_capture - - -DOTNET_UNIX_EPOCH_TICKS = 621355968000000000 - - -def ticks_to_unix_ns(ticks: int) -> int: - return (ticks - DOTNET_UNIX_EPOCH_TICKS) * 100 - - -def safe_float(value: str, default=None): - try: - return float(value) - except (TypeError, ValueError): - return default - - -def safe_int(value: str, default=None): - try: - return int(value) - except (TypeError, ValueError): - return default - - -def nmea_checksum_valid(line: str) -> bool: - star = line.rfind("*") - if star < 0: - return False - try: - expected = int(line[star + 1:star + 3], 16) - except ValueError: - return False - value = 0 - for char in line[1:star]: - value ^= ord(char) - return value == expected - - -def unicore_crc32(text: str) -> int: - crc = 0 - for value in text.encode("ascii", "replace"): - crc ^= value - for _ in range(8): - crc = (crc >> 1) ^ (0xEDB88320 if crc & 1 else 0) - return crc & 0xFFFFFFFF - - -def unicore_checksum_valid(line: str) -> bool: - star = line.rfind("*") - if star < 0 or len(line) < star + 9: - return False - try: - expected = int(line[star + 1:star + 9], 16) - except ValueError: - return False - return unicore_crc32(line[1:star]) == expected - - -def parse_checksum(line: str) -> bool: - if line.startswith("$"): - return nmea_checksum_valid(line) - if line.startswith("#"): - return unicore_checksum_valid(line) - return False - - -def parse_nmea_latlon(value: str, hemisphere: str): - raw = safe_float(value) - if raw is None: - return None - degrees = math.floor(raw / 100.0) - result = degrees + (raw - degrees * 100.0) / 60.0 - if hemisphere.upper() in ("S", "W"): - result = -result - return result - - -def parse_gga(line: str) -> dict: - fields = line[:line.rfind("*")].split(",") - if len(fields) < 10: - raise ValueError("GGA has too few fields") - return { - "type": "GGA", - "position_time_utc": fields[1], - "lat_deg": parse_nmea_latlon(fields[2], fields[3]), - "lon_deg": parse_nmea_latlon(fields[4], fields[5]), - "fix_quality": safe_int(fields[6], -1), - "satellites": safe_int(fields[7], -1), - "hdop": safe_float(fields[8]), - "altitude_m": safe_float(fields[9]), - "geoid_separation_m": safe_float(fields[11]) if len(fields) > 11 else None, - "differential_age_s": safe_float(fields[13]) if len(fields) > 13 else None, - "station_id": fields[14].strip('"') if len(fields) > 14 else "", - } - - -def parse_heading(line: str) -> dict: - before_crc = line[:line.rfind("*")] - header, payload = before_crc.split(";", 1) - header_fields = header.split(",") - fields = payload.split(",") - if len(fields) < 7: - raise ValueError("UNIHEADINGA has too few fields") - raw_heading = safe_float(fields[3]) - return { - "type": "UNIHEADINGA", - "gnss_week": safe_int(header_fields[4]) if len(header_fields) > 4 else None, - "gnss_tow_ms": safe_int(header_fields[5]) if len(header_fields) > 5 else None, - "heading_status": fields[0], - "heading_solution": fields[1], - "baseline_length_m": safe_float(fields[2]), - "raw_heading_deg": raw_heading, - "pitch_deg": safe_float(fields[4]), - "heading_stddev_deg": safe_float(fields[6]), - "pitch_stddev_deg": safe_float(fields[7]) if len(fields) > 7 else None, - "station_id": fields[8].strip('"') if len(fields) > 8 else "", - "satellites": safe_int(fields[9], -1) if len(fields) > 9 else -1, - "solution_satellites": safe_int(fields[10], -1) if len(fields) > 10 else -1, - "observations": safe_int(fields[11], -1) if len(fields) > 11 else -1, - "multi_count": safe_int(fields[12], -1) if len(fields) > 12 else -1, - "heading_valid": fields[0] == "SOL_COMPUTED" and fields[1] in {"NARROW_INT", "NARROW_FLOAT"}, - } - - -def chunk_source(chunks: list[RawChunk], offset: int, end: int) -> dict: - first = chunks[0] - last = chunks[-1] - cursor = 0 - start_chunk = first - end_chunk = last - for chunk in chunks: - chunk_start = cursor - chunk_end = cursor + len(chunk.raw) - if chunk_start <= offset < chunk_end: - start_chunk = chunk - if chunk_start < end <= chunk_end: - end_chunk = chunk - break - cursor = chunk_end - return { - "source_segment_id": None, - "source_chunk_sequence_first": start_chunk.sequence, - "source_chunk_sequence_last": end_chunk.sequence, - "source_raw_file_offset": start_chunk.raw_file_offset + max(0, offset - sum(len(c.raw) for c in chunks if c.sequence < start_chunk.sequence)), - "source_raw_byte_length": max(0, end - offset), - } - - -def parse_rtk_capture(capture: CaptureFile) -> list[dict]: - rows = [] - for segment_id, chunks in iter_contiguous_segments(capture.chunks): - stream = b"".join(chunk.raw for chunk in chunks) - cursor = 0 - while cursor < len(stream): - newline = stream.find(b"\n", cursor) - if newline < 0: - break - end = newline + 1 - raw_line = stream[cursor:end].rstrip(b"\r\n") - cursor = end - if not raw_line: - continue - line = raw_line.decode("ascii", "replace") - valid = parse_checksum(line) - row = { - "type": "UNKNOWN", - "raw_line": line, - "checksum_valid": valid, - "host_receive_utc_ns": ticks_to_unix_ns(chunks[-1].receive_utc_ticks), - "host_receive_monotonic_ticks": chunks[-1].receive_monotonic_ticks, - "source_segment_id": segment_id, - "source_byte_offset_in_segment": cursor - len(raw_line) - 1, - "source_byte_length": len(raw_line) + 1, - } - try: - if line.startswith("$GNGGA") or line.startswith("$GPGGA"): - row.update(parse_gga(line)) - elif line.startswith("#UNIHEADINGA"): - row.update(parse_heading(line)) - except ValueError as ex: - row["parse_error"] = str(ex) - rows.append(row) - return rows - - -def crc16_hi13(data: bytes) -> int: - crc = 0 - for value in data: - crc ^= value << 8 - for _ in range(8): - crc = ((crc << 1) ^ 0x1021) & 0xFFFF if crc & 0x8000 else (crc << 1) & 0xFFFF - return crc - - -def decode_hi91(frame: bytes) -> dict: - f32 = lambda i: struct.unpack_from(" dict: - i16 = lambda i: struct.unpack_from(" list[dict]: - rows = [] - for segment_id, chunks in iter_contiguous_segments(capture.chunks): - stream = b"".join(chunk.raw for chunk in chunks) - cursor = 0 - while True: - start = stream.find(b"\x5a\xa5", cursor) - if start < 0 or start + 6 > len(stream): - break - payload_length = int.from_bytes(stream[start + 2:start + 4], "little") - frame_length = 6 + payload_length - if payload_length <= 0 or payload_length > 512: - cursor = start + 1 - continue - if start + frame_length > len(stream): - break - frame = stream[start:start + frame_length] - expected = int.from_bytes(frame[4:6], "little") - actual = crc16_hi13(frame[:4] + frame[6:]) - end = start + frame_length - source = chunk_source(chunks, start, end) - source["source_segment_id"] = segment_id - row = { - "type": "HI13", - "tag": frame[6], - "frame_length": frame_length, - "crc_valid": expected == actual, - "host_receive_utc_ns": ticks_to_unix_ns(chunks[-1].receive_utc_ticks), - "host_receive_monotonic_ticks": chunks[-1].receive_monotonic_ticks, - "source_segment_id": segment_id, - "source_byte_offset_in_segment": start, - "source_byte_length": frame_length, - "raw_frame_hex": frame.hex(), - } - if expected == actual: - try: - row.update(decode_hi91(frame) if frame[6] == 0x91 else decode_hi92(frame) if frame[6] == 0x92 else {}) - except (IndexError, struct.error, ValueError) as ex: - row["parse_error"] = str(ex) - rows.append(row) - cursor = end - return rows - - -def write_jsonl(path: Path, rows: Iterable[dict]) -> None: - with path.open("w", encoding="utf-8", newline="\n") as stream: - for row in rows: - stream.write(json.dumps(row, ensure_ascii=False, separators=(",", ":")) + "\n") - - -def write_json(path: Path, value: dict) -> None: - path.write_text(json.dumps(value, ensure_ascii=False, indent=2), encoding="utf-8") - - -def load_jsonl(path: Path) -> list[dict]: - with path.open("r", encoding="utf-8") as stream: - return [json.loads(line) for line in stream if line.strip()] diff --git a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common_corrected.py b/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common_corrected.py deleted file mode 100644 index 35b37ef..0000000 --- a/LiDAR_RTK_Direct_Calibration/tools/rscap_v2/pipeline_common_corrected.py +++ /dev/null @@ -1,106 +0,0 @@ -from __future__ import annotations - -import bisect - -from pipeline_common import * -from capture_format_v2 import CaptureFile, RawChunk, iter_contiguous_segments - - -_SPAN_CACHE: dict[int, tuple[list[RawChunk], list[int]]] = {} - - -def _chunk_starts(chunks: list[RawChunk]) -> list[int]: - key = id(chunks) - cached = _SPAN_CACHE.get(key) - if cached is not None and cached[0] is chunks: - return cached[1] - starts = [] - cursor = 0 - for chunk in chunks: - starts.append(cursor) - cursor += len(chunk.raw) - _SPAN_CACHE[key] = (chunks, starts) - return starts - - -def source_for_span(chunks: list[RawChunk], start: int, end: int, segment_id: int) -> dict: - starts = _chunk_starts(chunks) - start_index = max(0, min(len(chunks) - 1, bisect.bisect_right(starts, start) - 1)) - end_index = max(start_index, min(len(chunks) - 1, bisect.bisect_left(starts, end) - 1)) - start_chunk = chunks[start_index] - end_chunk = chunks[end_index] - return { - "source_segment_id": segment_id, - "source_chunk_sequence_first": start_chunk.sequence, - "source_chunk_sequence_last": end_chunk.sequence, - "source_raw_file_offset": start_chunk.raw_file_offset + (start - starts[start_index]), - "source_raw_byte_length": end - start, - "host_receive_utc_ns": ticks_to_unix_ns(end_chunk.receive_utc_ticks), - "host_receive_monotonic_ticks": end_chunk.receive_monotonic_ticks, - } - -def parse_rtk_capture(capture: CaptureFile) -> list[dict]: - rows = [] - for segment_id, chunks in iter_contiguous_segments(capture.chunks): - stream = b"".join(chunk.raw for chunk in chunks) - cursor = 0 - while cursor < len(stream): - newline = stream.find(b"\n", cursor) - if newline < 0: - break - end = newline + 1 - raw_line = stream[cursor:end].rstrip(b"\r\n") - start = cursor - cursor = end - if not raw_line: - continue - line = raw_line.decode("ascii", "replace") - row = {"type": "UNKNOWN", "raw_line": line, "checksum_valid": parse_checksum(line)} - row.update(source_for_span(chunks, start, end, segment_id)) - try: - if line.startswith("$GNGGA") or line.startswith("$GPGGA"): - row.update(parse_gga(line)) - elif line.startswith("#UNIHEADINGA"): - row.update(parse_heading(line)) - except ValueError as ex: - row["parse_error"] = str(ex) - rows.append(row) - return rows - - -def parse_imu_capture(capture: CaptureFile) -> list[dict]: - rows = [] - for segment_id, chunks in iter_contiguous_segments(capture.chunks): - stream = b"".join(chunk.raw for chunk in chunks) - cursor = 0 - while True: - start = stream.find(b"\x5a\xa5", cursor) - if start < 0 or start + 6 > len(stream): - break - payload_length = int.from_bytes(stream[start + 2:start + 4], "little") - frame_length = 6 + payload_length - if payload_length <= 0 or payload_length > 512: - cursor = start + 1 - continue - if start + frame_length > len(stream): - break - frame = stream[start:start + frame_length] - expected = int.from_bytes(frame[4:6], "little") - actual = crc16_hi13(frame[:4] + frame[6:]) - end = start + frame_length - row = { - "type": "HI13", - "tag": frame[6], - "frame_length": frame_length, - "crc_valid": expected == actual, - "raw_frame_hex": frame.hex(), - } - row.update(source_for_span(chunks, start, end, segment_id)) - if row["crc_valid"]: - try: - row.update(decode_hi91(frame) if frame[6] == 0x91 else decode_hi92(frame) if frame[6] == 0x92 else {}) - except (IndexError, struct.error, ValueError) as ex: - row["parse_error"] = str(ex) - rows.append(row) - cursor = end - return rows diff --git a/PAIR_DIAGNOSTICS.md b/PAIR_DIAGNOSTICS.md deleted file mode 100644 index 72b96ae..0000000 --- a/PAIR_DIAGNOSTICS.md +++ /dev/null @@ -1,85 +0,0 @@ -# Pair 局部诊断与全局灵敏度扫描 - -本说明补充主 README。所有变换均采用: - -```text -X = T_body_lidar -A_ij X = X B_ij -B_ij = T_Li_Lj(把站点 j 点云变到站点 i) -``` - -模式 4 相对模式 3 的数值差定义为: - -```text -Delta_ij = B_ij^-1 * (X^-1 * A_ij * X) -``` - -打印的平移 xyz 和旋转 RPY 是 `Delta_ij` 在站点 j 雷达局部坐标系中的分量,不是屏幕坐标。3D 相机视角会改变画面中的“横向”,所以不能仅凭屏幕左右判断车体系 Y 或 yaw。 - -## Pair 0 当前诊断 - -Open3D 精筛 Pair 0(station 0 <- 1)的当前结果为: - -```text -translation xyz = [-1.2535, +1.4157, +7.7441] cm -rotation RPY xyz = [-0.5355, -0.1093, +0.0247] deg -norm = 7.9716 cm / 0.547109 deg -``` - -因此这对主要表现为 roll/pitch 相关姿态差和相对 Z 差,yaw 仅约 `0.025 deg`,不应优先调 yaw。 - -## 可视化试验 - -查看原结果: - -```powershell -$Repo = "D:\你的代码目录\calibration" -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\view_open3d_result.ps1" -PairIndex 0 -``` - -试验车体系左乘 pitch `+0.2 deg`: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\view_open3d_result.ps1" -PairIndex 0 -LeftPitchDeg 0.2 -``` - -此时按键含义:`3` 为 GICP 的 B,`4` 为当前最终 X 预测,`5` 为试验修正后的 X 预测。试验使用: - -```text -X_test = DeltaR_body * X -``` - -这是真正的车体系左乘,会同时旋转 X 的旋转部分和平移向量;小角度下才近似等价于直接给 JSON 的 pitch 加相同角度。 - -## 全部运动对扫描 - -运行: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_sensitivity_scan.ps1" -PairIndex 0 -``` - -程序扫描: - -- pitch:`+0.1/+0.2/+0.3 deg`; -- 在这些 pitch 及零 pitch 附近扫描 roll:`-0.2/-0.1/+0.1 deg`; -- yaw `-0.2/+0.2 deg` 只作为低灵敏度对照; -- Open3D 全部精筛对、small_gicp 全部精筛对、跨后端共识对分别计算; -- 同时报告地面法向与高度残差; -- 使用 `0.05 m / 0.5 deg` 作为透明的归一化尺度,统计全局 RMS、改善对数和恶化对数。 - -输出位于 `results/diagnostics/`。JSON 保存逐对结果,CSV 便于横向比较。 - -## 接受规则 - -局部扫描只用于定位,程序不会覆盖 `final_extrinsic_recommended.json`。候选至少需要满足: - -1. 不能只改善 Pair 0;全部精筛对的归一化 RMS 应下降; -2. 改善的运动对数量应多于恶化数量; -3. Open3D、small_gicp 与共识集合应给出相同方向的趋势; -4. 地面法向和高度约束不能明显恶化; -5. 多个代表性运动对的模式 4/5 可视化应同步改善。 - -如果只有 Pair 0 改善,应把它视为局部配准或场景问题,不修改全局 X。 - -对于当前仅含 yaw 的 RTK A,车体系 Z 轴平移在 AX=XB 中不可观。扫描程序会用 `X.z + 0.10 m` 做数值检查,但不会扫描或修改 z;z 必须由地面高度约束或外部量测确定。 diff --git a/README.md b/README.md index d6b6d18..95ff8cf 100644 --- a/README.md +++ b/README.md @@ -1,226 +1,185 @@ -# LiDAR–双天线 RTK 手眼标定 +# 双天线RTK—3D LiDAR直接手眼标定 -本仓库提供一套可从原始 Medulla 记录复现的静态站点标定流程,求解三维激光雷达到后轮轴中心车体系的外参 +本仓库从静态站点原始数据复现 `T_RTK_lidar`:把原始雷达坐标转换到RTK导航坐标系。它**不是** `base_link` 车体外参,也不会在求解阶段使用车体航向偏置或RTK到后轮轴的XY杆臂。 + +## 1. 输出坐标约定 + +统一约定 `T_A_B` 把B系点变换到A系: ```text -X = T_body_lidar +p_RTK = T_RTK_lidar · p_lidar ``` -约定 `T_A_B` 将 B 系坐标变换到 A 系。对任意站点 i、j: +RTK导航系在本仓库中定义为: + +- 原点:GGA位置参考点(通常为ANT1相位中心,必须结合接收机配置确认); +- X轴:`rawHeading`所表示的双天线基线在水平面的投影; +- Y轴:左; +- Z轴:上; +- ENU航向:`yaw = 90° - rawHeading`; +- roll、pitch:当前轨迹中固定为0。 + +如果下游需要 `T_body_lidar`,必须另有经过确认的 `T_body_rtk`: ```text -A_ij = T_W_Bi^-1 T_W_Bj # RTK 给出的车体相对运动 -B_ij = T_Li_Lj # GICP 给出的雷达相对运动 -A_ij X = X B_ij +T_body_lidar = T_body_rtk · T_RTK_lidar ``` -当前部署建议仍采用 [results/01_previous_two_batches/final_extrinsic_deployment.json](results/01_previous_two_batches/final_extrinsic_deployment.json)。data4 是一次独立重算,结果与部署值相差约 `1.592 cm / 0.234°`,但自身 AX 残差更高,因此只作为候选和稳定性证据,不自动替换部署值。 +## 2. 算法流程 -## 标定总流程 - -```mermaid -flowchart LR - raw["原始站点 dlog / RTK、IMU rscap"] --> export["分别解析并统一到时间轴"] - export --> assoc["按每个 LiDAR 帧关联 RTK/IMU,导出 NPZ"] - assoc --> prep["每站选一帧,构建 RTK 车体位姿 A"] - prep --> b1["small_gicp 求 B"] - prep --> b2["Open3D GICP 求 B"] - b1 --> gate["与 X 无关的质量筛选及双后端一致性"] - b2 --> gate - gate --> solve["AX=XB + 地面约束求 X"] - solve --> check["残差、bootstrap、条件数、跨批复核和 3D 可视化"] +```text +逐站LiDAR dlog + RTK.rscap + IMU.rscap + → 分别解析并保留原始字段 + → 以LiDAR帧时间为索引关联RTK/IMU,生成combined NPZ + → 每站选择一帧静态点云,GGA转局部ENU,rawHeading构造yaw-only RTK pose + → Open3D GICP和small_gicp分别求 B_ij = T_Li_Lj + → 留出点、Hessian、正反向、多初值和旋转共轭不变量筛选 + → 两后端共同认可的边形成consensus B + → A_ij X = X B_ij + 地面法向/高度约束求 X = T_RTK_lidar + → bootstrap、双后端差异、逐对残差和3D可视化检查 ``` -流程有两个原始数据入口: +代码实际使用: -- 旧式数据:LiDAR 和 `GPS-POST-Z` 位于每个站点 dlog 中,使用 `export_legacy_stations.ps1`。 -- 新式多传感器数据:LiDAR 位于逐站 dlog,RTK 与 IMU 是独立 `.rscap`,使用 `export_multisensor_stations.ps1`。处理顺序是统一时间轴、分别解析、按 LiDAR 帧关联、导出 NPZ。 +```text +A_ij = inv(T_W_Ri) · T_W_Rj = T_Ri_Rj +B_ij = T_Li_Lj # 将站点j点云变换到站点i +A_ij · X = X · B_ij +X = T_RTK_lidar +``` -IMU 会在新式数据中原样解析并随 LiDAR 帧关联保存,但当前 LiDAR–RTK 外参求解不使用 IMU,也不做运动畸变校正,因为每一站采集点云时车辆静止。IMU 外参应使用单独的激励数据和专用标定流程求解。 +## 3. 原始数据目录 -## 三批数据的角色 +大体积数据不提交Git。`DataRoot`下每个站点必须是一个独立dlog目录,至少包含: -| 数据 | 原始格式 | 站点 | RTK 情况 | 在本仓库中的角色 | -|---|---|---:|---|---| -| 第一批 | 逐站 dlog,内嵌 GPS-POST-Z | 38 | 约 10 秒一条,部分站仅 1–11 个有效样本 | 辅助复核,不承担主要求解 | -| 第二批 | 逐站 dlog,内嵌 GPS-POST-Z | 38 | 每站约 125–412 个有效样本,航向稳定 | 现部署外参的主要求解数据 | -| data4 | 逐站 LiDAR dlog + 独立 RTK/IMU rscap | 34 | 11,678 个 LiDAR 帧均成功关联 fixed RTK、heading 和 IMU | 独立重算与跨批比较 | +```text +raw_dataset/ +├── stations/ +│ ├── 001/ +│ │ ├── dobject/ +│ │ └── dobject_recording/ +│ ├── 002/ +│ └── ... +└── captures/ + ├── rtk.rscap + └── imu.rscap +``` -原始数据体积较大,不在 Git 仓库中。复现者应从云盘取得第一批、第二批或 data4 的原始目录,并在命令行传入路径。 +每个站点应在车辆完全静止后记录点云;建议不少于30站,并包含充足的直行、左转、右转和大角度转向姿态变化。 -## 环境 +## 4. 环境安装 -- Windows PowerShell 5.1 或 PowerShell 7 -- Python 3.10+ -- `pip install -r requirements.txt` -- `small_gicp` 后端需要可导入 `small_gicp`;Open3D 后端需要 `open3d` - -所有脚本从自身位置推导仓库根目录。数据和输出路径均由参数传入,不依赖开发者电脑上的固定路径。 - -## 从原始数据开始复现 - -以下路径只表示格式,请替换为自己的目录。 - -### A. 第一批、第二批旧式 dlog +已验证环境为Windows、PowerShell、Python 3.11。安装依赖: ```powershell -$Repo = "D:\你的代码目录\calibration" - -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\export_legacy_stations.ps1" ` - -DataRoot "D:\你的数据目录\batch2_raw" ` - -OutputRoot "D:\你的输出目录\batch2_export" - -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\prepare_legacy_dataset.ps1" ` - -ExportRoot "D:\你的输出目录\batch2_export" ` - -Output "D:\你的输出目录\batch2_prepared" ` - -HeadingOffsetDeg 21.226 ` - -AntennaLever -0.320,-0.365,0.620 ` - -ExpectedStations 38 ` - -HeadingStdLimitDeg 0.5 +python -m pip install -r requirements.txt ``` -第一批采用同一导出方式,但应在导出命令显式添加 `-RtkMaxDtMs 15000`;因其 RTK 稀疏,准备阶段也不建议沿用 `0.5°` 的严格站内航向离散度阈值。上述 `21.226°` 和杆臂 `[-0.320,-0.365,0.620] m` 是本项目已有两批数据采用的配置,不是通用常数;换车或改变天线安装后必须重新确认。 +依赖包括NumPy、SciPy、Open3D和small_gicp。若small_gicp没有对应Windows wheel,可在WSL2中安装后运行Python核心命令,或先只运行Open3D后端;完整共识流程需要两个后端都可用。 -### B. data4 式独立 RTK/IMU rscap +## 5. 从原始数据一键复现 + +在仓库根目录执行,路径由使用者通过参数传入,脚本内没有本机绝对路径: ```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\export_multisensor_stations.ps1" ` - -DataRoot "D:\你的数据目录\data4_raw" ` - -RtkCapture "D:\你的数据目录\captures\rtk.rscap" ` - -ImuCapture "D:\你的数据目录\captures\imu.rscap" ` - -OutputRoot "D:\你的输出目录\data4_export" +$Repo = (Resolve-Path ".").Path +$Raw = "E:\calibration_data\data4" +$Out = "E:\calibration_output\rtk_lidar" -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\prepare_multisensor_dataset.ps1" ` - -CombinedRoot "D:\你的输出目录\data4_export\combined" ` - -Output "D:\你的输出目录\data4_prepared" ` - -HeadingOffsetDeg 21.226 ` - -AntennaLever -0.320,-0.365,0.620 ` +powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_full_pipeline.ps1" ` + -DataRoot "$Raw\stations" ` + -RtkCapture "$Raw\captures\rtk.rscap" ` + -ImuCapture "$Raw\captures\imu.rscap" ` + -OutputRoot $Out ` + -RtkReferenceHeightAboveGroundM 0.8535 ` -ExpectedStations 34 ``` -### C. 运行标定 - -单批数据同时运行 small_gicp、Open3D GICP 和跨后端共识: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_single_dataset.ps1" ` - -Prepared "D:\你的输出目录\data4_prepared" ` - -OutputRoot "D:\你的输出目录\data4_calibration" ` - -BodyHeight 0.2335 -``` - -复现本仓库“第二批求解、第一批辅助复核”的历史流程: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_all.ps1" ` - -Batch1Prepared "D:\你的输出目录\batch1_prepared" ` - -Batch2Prepared "D:\你的输出目录\batch2_prepared" ` - -OutputRoot "D:\你的输出目录\two_batch_calibration" -``` - -`BodyHeight=0.2335 m` 是后轮轴中心离地高度,用于把雷达地面平面约束转换到车体原点;它不是雷达离地高度。换轮胎、胎压或车体载荷后应重新测量并评估不确定度。 - -## 如何判断结果 - -不能仅凭 `AX=XB` 残差或一张叠图宣称外参正确。至少同时检查: - -1. B 的配准质量:收敛、有效对应点数/比例、RMSE、Hessian 信息矩阵特征值与条件数、small_gicp 与 Open3D 的相对运动一致性。 -2. X 的可观性:加权雅可比条件数越接近 1 越均衡;极大值说明存在弱方向,但没有脱离尺度和数据分布的单一硬阈值。本次 data4 为 `7.44`,不是病态。 -3. AX 残差分布:看 RMS、median、P90/P95、max 和逐对异常,而不是只看均值。 -4. 重采样稳定性:bootstrap 的六自由度标准差及置信区间。 -5. 跨批检查:同一 X 在独立批次的残差,以及两批独立求出的 X 之 SE(3) 差。 -6. 3D 可视化:模式 3 的 B 与模式 4 的 `X^-1 A X` 是否都使相同墙面、杆件和地面重合。 - -当前没有把“增量小于某个值”当成绝对真值判据。工程筛查可先关注多数优质运动对是否约在厘米级到数厘米、亚度级;但阈值必须结合场景尺度、点云分辨率、RTK 质量和车辆运动幅度制定。模式 3 已错位时优先检查 B;模式 3 正常而模式 4 系统性错位时,再检查 A、坐标约定和 X。 - -## 结果摘要 - -| 结果 | 平移 xyz (m) | roll/pitch/yaw (deg) | AX 平移/旋转 RMS | 结论 | -|---|---|---|---|---| -| 部署值(第二批求解) | `[1.297760,-0.000067,0.720498]` | `[-0.785151,1.202661,-0.835510]` | `0.07985 m / 0.96118°`,39 对 | 当前建议部署 | -| data4 独立候选 | `[1.300376,-0.001707,0.704877]` | `[-0.791892,1.393823,-0.970743]` | `0.11762 m / 1.24257°`,26 对 | 独立候选,不替换部署值 | - -data4 候选相对部署值变化 `1.592 cm / 0.234°`,其中 z 低 `1.562 cm`。旧部署值作用于 data4 的残差约 `0.11953 m / 1.24836°`;data4 候选作用于历史第二批的残差约 `0.07931 m / 0.98926°`。两个 X 的跨批表现接近,当前数据不足以证明 data4 的较低 z 更接近真值。 - -## 仓库目录 +主要输出: ```text -code/ 标定、配准筛选、共识、比较和可视化核心程序 -tools/ 原始 dlog/rscap 解析、时间关联、NPZ 导出和数据准备 -run/ 不含本机固定路径的 PowerShell 入口 -results/ 历史两批、data4 与跨批比较三个结果目录 +$Out/ +├── exported/ +│ ├── export/ # 各站LiDAR逐帧NPZ +│ ├── parsed/ # RTK/IMU JSONL +│ └── combined/ # 按LiDAR帧关联后的多传感器NPZ +├── prepared_rtk_direct/ +│ ├── frames_all/ # 每站选中的静态帧 +│ └── reference_poses_rtk_gga_raw_heading.csv +└── calibration/ + ├── open3d_gicp/ + ├── small_gicp/ + ├── consensus/ + ├── summary.json + └── final_T_RTK_lidar.json ``` -完整复现流程和所有主要文件职责均在本 README;`run/README.md`、`tools/README.md` 和 [results/README.md](results/README.md) 只是目录内快速索引。 +若已经有`combined/`,可跳过原始导出: -## 代码、工具和运行入口职责 +```powershell +powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\run_direct_rtk_lidar.ps1" ` + -CombinedRoot "E:\calibration_output\exported\combined" ` + -WorkRoot "E:\calibration_output\prepared_rtk_direct" ` + -OutputRoot "E:\calibration_output\calibration" ` + -RtkReferenceHeightAboveGroundM 0.8535 ` + -ExpectedStations 34 +``` -根 README 是本仓库唯一的完整复现说明。`run/README.md`、`tools/README.md` 和 `results/README.md` 只作为进入对应目录时的快速索引,不承载另一套流程。 +## 6. 3D可视化 -### code:标定核心 +```powershell +powershell.exe -NoProfile -ExecutionPolicy Bypass -File "$Repo\run\view_result.ps1" ` + -Frames "$Out\prepared_rtk_direct\frames_all" ` + -Pairs "$Out\calibration\consensus\B_consensus.npz" ` + -Extrinsic "$Out\calibration\final_T_RTK_lidar.json" ` + -PairIndex 0 +``` -| 文件 | 职责 | -|---|---| -| `rigorous_calibration.py` | 核心 CLI。`ground` 拟合每站地面;`pairs` 用 small_gicp 或 Open3D GICP 求 B 和质量指标;`calibrate` 联合 AX=XB 与地面约束求 X;`validate` 计算指定 X 的逐对残差。 | -| `refine_pairs.py` | 根据收敛、RMSE、对应关系、Hessian/信息矩阵和运动覆盖筛选 B;不读取 X,避免循环挑选。 | -| `cross_backend_filter.py` | 对齐 Open3D 与 small_gicp 的同一站点对,只保留两个后端相互一致的 B。 | -| `finalize_consensus.py` | 汇总历史两批的 consensus B、外参和第一批辅助复核。 | -| `summarize_results.py` | 汇总两个后端的外参、B 质量和跨批检查,生成推荐结果。 | -| `compare_extrinsics.py` | 在 SE(3) 上计算两套外参的严格相对平移和旋转差。 | -| `visualize_pair_3d.py` | 交互显示原始点云、RTK A、GICP B、`X^-1AX`,并打印 `B^-1(X^-1AX)` 数值增量。 | -| `scan_extrinsic_sensitivity.py` | 对 X 左乘小角度 roll/pitch/yaw 扰动,检查指定运动对的局部敏感方向。 | +窗口中: -### tools:原始数据到 prepared +- 蓝色:目标站点i;橙色:站点j; +- `1`:原始点云; +- `2`:RTK运动A直接作为初值; +- `3`:GICP测得的B; +- `4`:最终外参预测的 `X^-1 A X`; +- `Q/Esc`:退出。 -| 文件 | 职责 | -|---|---| -| `frontlidar_dlog_export.py` | 从 Medulla dlog 导出传感器坐标系 `points_raw`;旧格式可同时匹配站内 GPS-POST-Z。 | -| `prepare_station_dataset.py` | 从旧式逐站导出中每站选择一帧,计算 yaw-only RTK 后轮轴位姿并生成 prepared。 | -| `build_multisensor_npz.py` | 将独立 LiDAR、RTK、IMU 统一到 LiDAR 帧索引并生成 combined NPZ。 | -| `prepare_multisensor_station_dataset.py` | 从 combined NPZ 选择每站静止帧,生成与旧流程相同的 prepared 接口。 | -| `rscap_v2/capture_format_v2.py` | 读取 rscap v2 文件头、原始记录块和文件尾。 | -| `rscap_v2/audit_capture_v2.py` | 审计 capture 完整性、时间范围和记录统计。 | -| `rscap_v2/parse_rtk_imu_v2.py` | 分别解析 RTK 与 IMU capture,输出 JSONL。 | -| `rscap_v2/pipeline_common*.py` | rscap 解析、时间处理和采集格式兼容的共用逻辑。 | +模式3和4应让同一墙面、立柱、路缘和地面尽量重合。终端同时打印 `B^-1(X^-1AX)` 的平移和旋转增量。应查看多对,不能只挑视觉效果最好的一对。 -### run:推荐 PowerShell 入口 +## 7. data4参考结果 -| 文件 | 职责 | -|---|---| -| `export_legacy_stations.ps1` | 批量导出 LiDAR 与 RTK 同在逐站 dlog 中的旧格式。 | -| `export_multisensor_stations.ps1` | 解析独立 RTK/IMU,导出逐站 LiDAR,并按 LiDAR 帧建立关联。 | -| `prepare_legacy_dataset.ps1` | 旧式导出结果转换为 prepared。 | -| `prepare_multisensor_dataset.ps1` | combined 多传感器结果转换为 prepared。 | -| `run_single_dataset.ps1` | 单批数据同时完成两个 GICP 后端、B 筛选、consensus 和 X 求解。 | -| `run_all.ps1` | 历史流程:第二批求解,第一批稀疏 RTK 数据作辅助复核。 | -| `run_consensus_finish.ps1` | 在已有两个后端 B 的基础上重新生成 consensus 和汇总结果。 | -| `run_sensitivity_scan.ps1` | 对历史运动对执行外参角度灵敏度扫描。 | -| `view_result.ps1` | 传入匹配的 frames、B 和 X,运行交互式 3D 可视化。 | - -### 标定核心文件的数据关系 +仓库保留了精简参考产物,见[`results/reference_data4`](results/reference_data4/README.md): ```text -原始 dlog/rscap - -> tools 导出和时间关联 - -> prepared/{frames_all, body_poses_*.csv} - -> rigorous_calibration.py pairs 生成 A、B - -> refine_pairs.py 做与 X 无关的 B 筛选 - -> cross_backend_filter.py 生成 consensus B - -> rigorous_calibration.py calibrate 联合 AX=XB 与地面约束求 X - -> validate / visualize_pair_3d.py 做数值和三维检查 +translation_m = [1.638179350, -0.240844799, 0.084481236] +RPY_deg_xyz = [-0.817167459, 1.323288119, -22.104163318] + +站点:34 +共识运动对:25 +AX Translation RMS:0.100207 m +AX Rotation RMS:1.252794° +Weighted Jacobian condition:7.739413 +Open3D vs small_gicp:0.003889 m / 0.188431° ``` +唯一建议下游读取的参考结果是[`final_T_RTK_lidar.json`](results/reference_data4/final_T_RTK_lidar.json)。 -## 重要限制 +## 8. z与精度限制 -- RTK 车体姿态当前是双天线 heading 构造的 yaw-only 轨迹;没有用 RTK pitch/roll 构造 A。 -- 新式解析器保存 IMU 与 RTK pitch 等原始字段,但当前手眼方程未融合 IMU。 -- 静止站点法不估计 LiDAR–RTK 时间偏移;时间戳关联必须在导出阶段通过审计。 -- 地面约束负责 roll、pitch 和 z 的补充可观性,不会独立求出另一套六自由度外参。 -- 仓库归档的是结果和轻量 B 文件,不包含云盘中的原始点云数据。 +平面阿克曼运动不能独立观测z。参考结果使用34站地面平面和RTK参考点离地`0.8535 m`约束z;该高度必须量到实际GGA参考点/天线相位中心。更改参考高度后必须重新求解。 -## 专题说明 +AX残差、Hessian/Jacobian条件数、bootstrap和双后端一致性只证明内部一致性,不能单独证明逐帧GT达到±3 cm。当前关联仍以LiDAR和串口主机接收时间为主;GNSS周/周内时间和IMU设备时间被保留,但没有联合估计时钟偏移与漂移。用于连续GT pose前,应补做严格设备时间同步和独立轨迹验证。 -- [运动对诊断](PAIR_DIAGNOSTICS.md) -- [双后端共识筛选](CONSENSUS_SELECTION.md) -- [结果文件索引](results/README.md) +此外,代码无法单独证明GGA对应哪根物理天线、`rawHeading`是ANT1→ANT2还是ANT2→ANT1;必须用接收机配置、接线和现场运动实验确认。方向错误会导致RTK坐标系yaw相差约180°。 + +## 9. 仓库目录 + +| 目录 | 职责 | +|---|---| +| [`code/`](code/) | GICP、运动对质量评价、AX=XB求解、结果封装和3D可视化 | +| [`tools/`](tools/) | 原始dlog/rscap解析、按LiDAR帧关联及静态站点prepared生成 | +| [`run/`](run/) | PowerShell入口;所有数据和输出路径都通过参数传入 | +| [`results/reference_data4/`](results/reference_data4/) | 可提交Git的精简参考结果,不包含点云和本机过程目录 | +| `work/`、`outputs/` | 本地运行生成物,已由`.gitignore`排除 | + +各代码文件职责见[`code/README.md`](code/README.md),命令索引见[`run/README.md`](run/README.md),工具说明见[`tools/README.md`](tools/README.md)。 diff --git a/LiDAR_RTK_Direct_Calibration/code/README.md b/code/README.md similarity index 100% rename from LiDAR_RTK_Direct_Calibration/code/README.md rename to code/README.md diff --git a/code/compare_extrinsics.py b/code/compare_extrinsics.py index 4e8ca80..b407738 100644 --- a/code/compare_extrinsics.py +++ b/code/compare_extrinsics.py @@ -1,5 +1,5 @@ #!/usr/bin/env python3 -"""Compare two T_body_lidar JSON files in parameter space and on SE(3).""" +"""Compare two homogeneous-extrinsic JSON files in parameter space and on SE(3).""" import argparse import json diff --git a/code/finalize_consensus.py b/code/finalize_consensus.py deleted file mode 100644 index c38f037..0000000 --- a/code/finalize_consensus.py +++ /dev/null @@ -1,58 +0,0 @@ -#!/usr/bin/env python3 -"""Publish the cross-backend-consensus result as the recommended deliverable.""" -import argparse -import json -from pathlib import Path - - -def main(): - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--consensus-extrinsic", required=True) - parser.add_argument("--consensus-check", required=True) - parser.add_argument("--open3d-extrinsic", required=True) - parser.add_argument("--small-extrinsic", required=True) - parser.add_argument("--output", required=True) - parser.add_argument("--summary", required=True) - args = parser.parse_args() - consensus = json.loads(Path(args.consensus_extrinsic).read_text(encoding="utf-8-sig")) - check = json.loads(Path(args.consensus_check).read_text(encoding="utf-8-sig")) - open3d = json.loads(Path(args.open3d_extrinsic).read_text(encoding="utf-8-sig")) - small = json.loads(Path(args.small_extrinsic).read_text(encoding="utf-8-sig")) - summary = { - "recommended_method": "Open3D B gated by Open3D-small_gicp cross-backend agreement", - "selection_is_X_independent": True, - "second_batch_role": "estimation (dense RTK)", - "first_batch_role": "auxiliary check only (sparse RTK)", - "consensus": { - "translation_m": consensus["translation_m"], - "rotation_rpy_deg_xyz": consensus["rotation_rpy_deg_xyz"], - "estimation": consensus["estimation"]["residuals"], - "bootstrap_std": consensus["bootstrap"]["std"], - "batch1_auxiliary": check["metrics"], - }, - "separate_backend_results": { - "open3d_gicp": { - "translation_m": open3d["translation_m"], - "rotation_rpy_deg_xyz": open3d["rotation_rpy_deg_xyz"], - }, - "small_gicp": { - "translation_m": small["translation_m"], - "rotation_rpy_deg_xyz": small["rotation_rpy_deg_xyz"], - }, - }, - "warning": "AX rotation RMS remains about one degree; this is not centimetre-grade absolute certification.", - } - published = dict(consensus) - published["selection"] = { - "method": summary["recommended_method"], - "selection_is_X_independent": True, - "consensus_pair_threshold": "Open3D-small_gicp B delta <= 0.05 m and <= 0.50 deg", - "warning": summary["warning"], - } - Path(args.output).write_text(json.dumps(published, ensure_ascii=False, indent=2), encoding="utf-8") - Path(args.summary).write_text(json.dumps(summary, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps(summary, ensure_ascii=False, indent=2)) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/code/finalize_direct_rtk_lidar.py b/code/finalize_direct_rtk_lidar.py similarity index 100% rename from LiDAR_RTK_Direct_Calibration/code/finalize_direct_rtk_lidar.py rename to code/finalize_direct_rtk_lidar.py diff --git a/code/rigorous_calibration.py b/code/rigorous_calibration.py index 4732b0d..0974795 100644 --- a/code/rigorous_calibration.py +++ b/code/rigorous_calibration.py @@ -1,8 +1,9 @@ #!/usr/bin/env python3 -"""Rigorous stationary LiDAR / dual-antenna RTK hand-eye calibration. +"""Rigorous stationary LiDAR / reference-trajectory hand-eye calibration. Convention: T_A_B maps points from frame B into frame A. -X = T_body_lidar, A_ij = T_W_Bi^-1 T_W_Bj, B_ij = T_Li_Lj, +For this repository the reference frame is the RTK navigation frame. +X = T_RTK_lidar, A_ij = T_W_Ri^-1 T_W_Rj, B_ij = T_Li_Lj, therefore A_ij X = X B_ij. Raw sensor-frame points_raw are used. """ from __future__ import annotations @@ -367,17 +368,17 @@ def cmd_pairs(args): stations = load_stations( args.frames, args.min_range, args.max_range, args.z_min, args.z_max ) - body = read_poses(args.body) + reference = read_poses(args.reference_poses) if len(stations) < args.min_stations: raise ValueError(f"need at least {args.min_stations} stations, got {len(stations)}") - body_poses, body_dt = [], [] + reference_poses, reference_dt = [], [] for timestamp, _, _, xyz in stations: if len(xyz) < args.min_roi_points: raise ValueError(f"station at {timestamp} has only {len(xyz)} ROI points") - pose, dt = nearest_pose(body, timestamp + args.time_offset) - body_poses.append(pose) - body_dt.append(dt) - body_poses = np.asarray(body_poses) + pose, dt = nearest_pose(reference, timestamp + args.time_offset) + reference_poses.append(pose) + reference_dt.append(dt) + reference_poses = np.asarray(reference_poses) split = [split_holdout(station[3], args.holdout_fraction, i) for i, station in enumerate(stations)] rng = np.random.default_rng(args.seed) @@ -385,7 +386,7 @@ def cmd_pairs(args): accepted_transforms = {} for i in range(len(stations)): for j in range(i + args.min_gap, min(len(stations), i + args.max_gap + 1)): - a_ij = inverse_transform(body_poses[i]) @ body_poses[j] + a_ij = inverse_transform(reference_poses[i]) @ reference_poses[j] translation = float(np.linalg.norm(a_ij[:2, 3])) rotation = rotation_angle_deg(a_ij[:3, :3]) if translation < args.min_translation and rotation < args.min_rotation: @@ -445,7 +446,7 @@ def cmd_pairs(args): "lidar_time_i": stations[i][0], "lidar_time_j": stations[j][0], "frame_counter_i": stations[i][1], "frame_counter_j": stations[j][1], "rtk_translation_m": translation, "rtk_rotation_deg": rotation, - "nearest_rtk_dt_i_s": body_dt[i], "nearest_rtk_dt_j_s": body_dt[j], + "nearest_rtk_dt_i_s": reference_dt[i], "nearest_rtk_dt_j_s": reference_dt[j], "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", "B_ij_4x4": forward["transform"].tolist(), "backend": args.backend, "backend_converged": forward["converged"], @@ -474,7 +475,7 @@ def cmd_pairs(args): output, A=np.asarray(accepted_a), B=np.asarray(accepted_b), meta=np.asarray(accepted_meta), station_times=np.asarray([item[0] for item in stations]), - rtk_nearest_dt_s=np.asarray(body_dt), backend=np.asarray(args.backend), + rtk_nearest_dt_s=np.asarray(reference_dt), backend=np.asarray(args.backend), ) quality = { "schema_version": 2, @@ -556,7 +557,7 @@ def calibration_residual(params, a_array, b_array, planes, args): normal_body = x[:3, :3] @ plane[:3] values.extend((np.cross(normal_body, body_up) / args.plane_normal_sigma).tolist()) body_distance = plane[3] - float(normal_body @ x[:3, 3]) - values.append((body_distance - args.body_height) / args.plane_height_sigma) + values.append((body_distance - args.reference_height) / args.plane_height_sigma) return np.asarray(values) @@ -644,7 +645,7 @@ def cmd_calibrate(args): "schema_version": 2, "success": bool(best.success), "message": best.message, - "convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame", + "convention": "T_reference_lidar maps raw LiDAR points into the supplied reference frame", "equation": "A_ij X = X B_ij", "measured_extrinsic_used_as_initial": False, "translation_m": x[:3, 3].tolist(), @@ -655,8 +656,8 @@ def cmd_calibrate(args): "residuals": pair_metrics(a_array, b_array, x)}, "ground": { "planes": len(planes), - "body_origin_height_above_ground_m": args.body_height, - "formula": "d_lidar - (R_X n_lidar)^T t_X - body_height", + "reference_origin_height_above_ground_m": args.reference_height, + "formula": "d_lidar - (R_X n_lidar)^T t_X - reference_height", }, "linearized_one_sigma": { "translation_m": sigma[:3].tolist(), @@ -713,7 +714,8 @@ def build_parser(): pairs = commands.add_parser("pairs") pairs.add_argument("--backend", choices=["open3d", "small_gicp"], required=True) - pairs.add_argument("--frames", required=True); pairs.add_argument("--body", required=True) + pairs.add_argument("--frames", required=True) + pairs.add_argument("--reference-poses", "--body", dest="reference_poses", required=True) pairs.add_argument("--output", required=True); pairs.add_argument("--quality-json"); pairs.add_argument("--quality-csv") pairs.add_argument("--time-offset", type=float, default=0.0) pairs.add_argument("--min-stations", type=int, default=30); pairs.add_argument("--min-pairs", type=int, default=25) @@ -746,7 +748,7 @@ def build_parser(): calibrate.add_argument("--rotation-sigma", type=float, default=0.5) calibrate.add_argument("--plane-normal-sigma", type=float, default=0.02) calibrate.add_argument("--plane-height-sigma", type=float, default=0.03) - calibrate.add_argument("--body-height", type=float, default=0.2335) + calibrate.add_argument("--reference-height", "--body-height", dest="reference_height", type=float, default=0.8535) calibrate.add_argument("--solver-multistart", type=int, default=12) calibrate.add_argument("--start-translation-sigma", type=float, default=1.0) calibrate.add_argument("--start-rotation-sigma", type=float, default=20.0) diff --git a/code/scan_extrinsic_sensitivity.py b/code/scan_extrinsic_sensitivity.py deleted file mode 100644 index d277d64..0000000 --- a/code/scan_extrinsic_sensitivity.py +++ /dev/null @@ -1,311 +0,0 @@ -#!/usr/bin/env python3 -"""Scan body-left RPY corrections locally and validate them over every B pair. - -This command is diagnostic only. It never writes or replaces an extrinsic JSON. -""" -from __future__ import annotations - -import argparse -import csv -import json -import math -from pathlib import Path - -import numpy as np -from scipy.spatial.transform import Rotation - -from rigorous_calibration import ( - inverse_transform, read_pairs, read_planes, rotation_angle_deg, rpy_deg, -) - - -def statistics(values): - values = np.asarray(values, float) - return { - "rms": float(np.sqrt(np.mean(values ** 2))), - "median": float(np.median(values)), - "p90": float(np.quantile(values, 0.90)), - "p95": float(np.quantile(values, 0.95)), - "max": float(np.max(values)), - } - - -def body_left_rpy(x, rpy_correction_deg): - correction = np.eye(4) - correction[:3, :3] = Rotation.from_euler( - "xyz", np.asarray(rpy_correction_deg, float), degrees=True - ).as_matrix() - return correction @ x - - -def pair_delta(a_ij, b_ij, x): - predicted = inverse_transform(x) @ a_ij @ x - delta = inverse_transform(b_ij) @ predicted - translation = np.asarray(delta[:3, 3], float) - return { - "translation_xyz_m": translation.tolist(), - "translation_xyz_cm": (100.0 * translation).tolist(), - "translation_norm_m": float(np.linalg.norm(translation)), - "rotation_rpy_deg_xyz": rpy_deg(delta[:3, :3]), - "rotation_angle_deg": rotation_angle_deg(delta[:3, :3]), - } - - -def ground_metrics(planes, x, body_height): - if len(planes) == 0: - return None - up = np.array([0.0, 0.0, 1.0]) - tilt_deg, height_m = [], [] - for plane in planes: - normal_body = x[:3, :3] @ plane[:3] - normal_body /= np.linalg.norm(normal_body) - tilt_deg.append(math.degrees(math.atan2( - np.linalg.norm(np.cross(normal_body, up)), - float(np.clip(normal_body @ up, -1.0, 1.0)), - ))) - height_m.append( - float(plane[3] - normal_body @ x[:3, 3] - body_height) - ) - return { - "normal_tilt_deg": statistics(tilt_deg), - "height_residual_m": statistics(height_m), - } - - -def evaluate(label, correction, a_array, b_array, meta, x, pair_index, - translation_scale, rotation_scale, planes, body_height): - candidate_x = body_left_rpy(x, correction) - per_pair = [] - translation, rotation, normalized = [], [], [] - for index, (a_ij, b_ij, pair_meta) in enumerate(zip(a_array, b_array, meta)): - item = pair_delta(a_ij, b_ij, candidate_x) - item.update({ - "pair_index": index, - "i": int(pair_meta[0]), - "j": int(pair_meta[1]), - }) - t = item["translation_norm_m"] - r = item["rotation_angle_deg"] - translation.append(t) - rotation.append(r) - normalized.append(math.hypot(t / translation_scale, r / rotation_scale)) - per_pair.append(item) - return { - "label": label, - "body_left_rpy_correction_deg_xyz": list(map(float, correction)), - "candidate_extrinsic": { - "translation_m": candidate_x[:3, 3].tolist(), - "rotation_rpy_deg_xyz": rpy_deg(candidate_x[:3, :3]), - }, - "all_pairs": { - "count": len(per_pair), - "translation_m": statistics(translation), - "rotation_deg": statistics(rotation), - "normalized_pair_score": statistics(normalized), - "normalized_global_rms": float(np.sqrt(np.mean(np.asarray(normalized) ** 2))), - }, - "selected_pair": per_pair[pair_index], - "ground": ground_metrics(planes, candidate_x, body_height), - "per_pair": per_pair, - } - - -def candidate_grid(pitch_values, roll_values, yaw_values): - answer = [("baseline", (0.0, 0.0, 0.0))] - for pitch in pitch_values: - answer.append((f"pitch_{pitch:+.3f}", (0.0, pitch, 0.0))) - for pitch in (0.0, *pitch_values): - for roll in roll_values: - answer.append(( - f"pitch_{pitch:+.3f}_roll_{roll:+.3f}", - (roll, pitch, 0.0), - )) - for yaw in yaw_values: - answer.append((f"yaw_{yaw:+.3f}_diagnostic", (0.0, 0.0, yaw))) - unique = [] - seen = set() - for label, values in answer: - key = tuple(round(float(value), 12) for value in values) - if key not in seen: - seen.add(key) - unique.append((label, values)) - return unique - - -def z_observability(a_array, x, test_shift_m): - shift = np.eye(4) - shift[2, 3] = test_shift_m - shifted_x = shift @ x - effects = [] - for a_ij in a_array: - before = inverse_transform(x) @ a_ij @ x - after = inverse_transform(shifted_x) @ a_ij @ shifted_x - delta = inverse_transform(before) @ after - effects.append(( - float(np.linalg.norm(delta[:3, 3])), - rotation_angle_deg(delta[:3, :3]), - )) - effects = np.asarray(effects, float) - maximum = np.max(effects, axis=0) - return { - "body_left_z_test_shift_m": test_shift_m, - "max_predicted_motion_change_translation_m": float(maximum[0]), - "max_predicted_motion_change_rotation_deg": float(maximum[1]), - "numerically_unobservable": bool(maximum[0] < 1e-10 and maximum[1] < 1e-10), - "note": "AX pairs cannot determine X.z when every A rotation preserves body Z; use ground/external height constraints.", - } - - -def main(): - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--pairs", required=True) - parser.add_argument("--extrinsic", required=True) - parser.add_argument("--output", required=True) - parser.add_argument("--csv") - parser.add_argument("--ground-planes") - parser.add_argument("--pair-index", type=int, default=0) - parser.add_argument("--pitch-values", nargs="+", type=float, default=[0.1, 0.2, 0.3]) - parser.add_argument("--roll-values", nargs="+", type=float, default=[-0.2, -0.1, 0.1]) - parser.add_argument("--yaw-values", nargs="+", type=float, default=[-0.2, 0.2]) - parser.add_argument("--translation-scale", type=float, default=0.05) - parser.add_argument("--rotation-scale", type=float, default=0.5) - parser.add_argument("--body-height", type=float, default=0.2335) - args = parser.parse_args() - - a_array, b_array, meta, stations = read_pairs(args.pairs) - if not 0 <= args.pair_index < len(a_array): - raise IndexError(f"pair-index {args.pair_index} outside [0,{len(a_array)-1}]") - with Path(args.extrinsic).open(encoding="utf-8-sig") as stream: - x = np.asarray(json.load(stream)["matrix_4x4"], float) - planes = read_planes(args.ground_planes) if args.ground_planes else np.empty((0, 4)) - - candidates = [ - evaluate( - label, correction, a_array, b_array, meta, x, args.pair_index, - args.translation_scale, args.rotation_scale, planes, args.body_height, - ) - for label, correction in candidate_grid( - args.pitch_values, args.roll_values, args.yaw_values - ) - ] - baseline = candidates[0] - baseline_scores = np.asarray([ - math.hypot( - item["translation_norm_m"] / args.translation_scale, - item["rotation_angle_deg"] / args.rotation_scale, - ) - for item in baseline["per_pair"] - ]) - base_global = baseline["all_pairs"]["normalized_global_rms"] - for candidate in candidates: - scores = np.asarray([ - math.hypot( - item["translation_norm_m"] / args.translation_scale, - item["rotation_angle_deg"] / args.rotation_scale, - ) - for item in candidate["per_pair"] - ]) - delta = scores - baseline_scores - candidate["comparison_to_baseline"] = { - "normalized_global_rms_change": float( - candidate["all_pairs"]["normalized_global_rms"] - base_global - ), - "improved_pairs": int(np.sum(delta < -1e-12)), - "worsened_pairs": int(np.sum(delta > 1e-12)), - "unchanged_pairs": int(np.sum(np.abs(delta) <= 1e-12)), - "median_per_pair_score_change": float(np.median(delta)), - "global_consistency_signal": bool( - candidate["all_pairs"]["normalized_global_rms"] < base_global - and np.sum(delta < -1e-12) > np.sum(delta > 1e-12) - ), - } - - ranking = sorted( - candidates, - key=lambda item: item["all_pairs"]["normalized_global_rms"], - ) - report = { - "schema_version": 1, - "diagnostic_only": True, - "extrinsic_was_modified": False, - "equation": "delta_ij = B_ij^-1 * (X^-1 * A_ij * X)", - "correction_convention": "X_test = DeltaR_body * X; DeltaR uses fixed body xyz RPY axes", - "component_frame": "delta translation/RPY components are in station-j LiDAR coordinates, not screen axes", - "selection_rule": ( - "Never accept a correction from selected_pair alone. Require improvement over all " - "refined pairs, directional consistency across pairs, acceptable ground constraints, " - "and independent visual review. This script never overwrites X." - ), - "pairs_file": str(Path(args.pairs).resolve()), - "extrinsic_file": str(Path(args.extrinsic).resolve()), - "stations": stations, - "pairs": len(a_array), - "selected_pair_index": args.pair_index, - "selected_pair_stations": [int(meta[args.pair_index, 0]), int(meta[args.pair_index, 1])], - "normalization": { - "translation_scale_m": args.translation_scale, - "rotation_scale_deg": args.rotation_scale, - }, - "z_observability": z_observability(a_array, x, 0.10), - "ranking_by_all_pair_normalized_rms": [ - { - "rank": rank, - "label": item["label"], - "body_left_rpy_correction_deg_xyz": item["body_left_rpy_correction_deg_xyz"], - "normalized_global_rms": item["all_pairs"]["normalized_global_rms"], - **item["comparison_to_baseline"], - } - for rank, item in enumerate(ranking, 1) - ], - "candidates": candidates, - } - - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - output.write_text(json.dumps(report, ensure_ascii=False, indent=2), encoding="utf-8") - csv_path = Path(args.csv) if args.csv else output.with_suffix(".csv") - with csv_path.open("w", encoding="utf-8", newline="") as stream: - fields = [ - "label", "roll_correction_deg", "pitch_correction_deg", "yaw_correction_deg", - "selected_pair_translation_cm", "selected_pair_rotation_deg", - "all_pair_translation_rms_m", "all_pair_rotation_rms_deg", - "normalized_global_rms", "normalized_global_rms_change", - "improved_pairs", "worsened_pairs", "global_consistency_signal", - "ground_normal_tilt_rms_deg", "ground_height_rms_m", - ] - writer = csv.DictWriter(stream, fieldnames=fields) - writer.writeheader() - for item in candidates: - correction = item["body_left_rpy_correction_deg_xyz"] - ground = item["ground"] - comparison = item["comparison_to_baseline"] - writer.writerow({ - "label": item["label"], - "roll_correction_deg": correction[0], - "pitch_correction_deg": correction[1], - "yaw_correction_deg": correction[2], - "selected_pair_translation_cm": item["selected_pair"]["translation_norm_m"] * 100.0, - "selected_pair_rotation_deg": item["selected_pair"]["rotation_angle_deg"], - "all_pair_translation_rms_m": item["all_pairs"]["translation_m"]["rms"], - "all_pair_rotation_rms_deg": item["all_pairs"]["rotation_deg"]["rms"], - "normalized_global_rms": item["all_pairs"]["normalized_global_rms"], - "normalized_global_rms_change": comparison["normalized_global_rms_change"], - "improved_pairs": comparison["improved_pairs"], - "worsened_pairs": comparison["worsened_pairs"], - "global_consistency_signal": comparison["global_consistency_signal"], - "ground_normal_tilt_rms_deg": None if ground is None else ground["normal_tilt_deg"]["rms"], - "ground_height_rms_m": None if ground is None else ground["height_residual_m"]["rms"], - }) - - print(json.dumps({ - "diagnostic_only": True, - "selected_pair": baseline["selected_pair"], - "z_observability": report["z_observability"], - "top_all_pair_candidates": report["ranking_by_all_pair_normalized_rms"][:8], - "output": str(output.resolve()), - "csv": str(csv_path.resolve()), - }, ensure_ascii=False, indent=2)) - - -if __name__ == "__main__": - main() diff --git a/code/summarize_results.py b/code/summarize_results.py deleted file mode 100644 index acde29d..0000000 --- a/code/summarize_results.py +++ /dev/null @@ -1,87 +0,0 @@ -#!/usr/bin/env python3 -"""Build a concise backend comparison and select the recommended result.""" -import argparse -import json -from pathlib import Path - -import numpy as np -from scipy.spatial.transform import Rotation - - -def main(): - parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument("--open3d", required=True) - parser.add_argument("--small", required=True) - parser.add_argument("--open3d-quality", required=True) - parser.add_argument("--small-quality", required=True) - parser.add_argument("--open3d-check", required=True) - parser.add_argument("--small-check", required=True) - parser.add_argument("--output", required=True) - parser.add_argument("--recommended-output", required=True) - args = parser.parse_args() - - open_result = json.loads(Path(args.open3d).read_text(encoding="utf-8-sig")) - small_result = json.loads(Path(args.small).read_text(encoding="utf-8-sig")) - open_quality = json.loads(Path(args.open3d_quality).read_text(encoding="utf-8-sig")) - small_quality = json.loads(Path(args.small_quality).read_text(encoding="utf-8-sig")) - open_check = json.loads(Path(args.open3d_check).read_text(encoding="utf-8-sig")) - small_check = json.loads(Path(args.small_check).read_text(encoding="utf-8-sig")) - x_open = np.asarray(open_result["matrix_4x4"], float) - x_small = np.asarray(small_result["matrix_4x4"], float) - delta = np.linalg.inv(x_open) @ x_small - - def compact(result, quality, check): - estimate = result["estimation"]["residuals"] - auxiliary = check["metrics"] - return { - "translation_m": result["translation_m"], - "rotation_rpy_deg_xyz": result["rotation_rpy_deg_xyz"], - "estimation_pairs": estimate["pairs"], - "estimation_translation_rms_m": estimate["translation_m"]["rms"], - "estimation_rotation_rms_deg": estimate["rotation_deg"]["rms"], - "bootstrap_std": result["bootstrap"]["std"], - "initial_B_loop_closure": quality["accepted_loop_closure"], - "batch1_auxiliary_pairs": auxiliary["pairs"], - "batch1_auxiliary_translation_rms_m": auxiliary["translation_m"]["rms"], - "batch1_auxiliary_rotation_rms_deg": auxiliary["rotation_deg"]["rms"], - } - - summary = { - "recommended_backend": "open3d_gicp", - "selection_reason": ( - "The two X estimates agree closely; Open3D has lower second-batch AX residual, " - "better B loop closure, and lower first-batch auxiliary residual." - ), - "coordinate_convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame", - "measured_extrinsic_used_as_initial": False, - "second_batch_role": "estimation (dense RTK)", - "first_batch_role": "auxiliary check only (sparse RTK)", - "backend_difference": { - "translation_m": float(np.linalg.norm(delta[:3, 3])), - "rotation_deg": float(np.rad2deg(Rotation.from_matrix(delta[:3, :3]).magnitude())), - }, - "open3d_gicp": compact(open_result, open_quality, open_check), - "small_gicp": compact(small_result, small_quality, small_check), - "important_limit": ( - "Backend agreement is strong, but AX rotation RMS remains about one degree. " - "This is not a centimetre-grade absolute certification." - ), - } - output = Path(args.output) - output.parent.mkdir(parents=True, exist_ok=True) - output.write_text(json.dumps(summary, ensure_ascii=False, indent=2), encoding="utf-8") - recommended = dict(open_result) - recommended["selection"] = { - "recommended_backend": "open3d_gicp", - "comparison_summary": str(output.name), - "backend_difference": summary["backend_difference"], - "warning": summary["important_limit"], - } - Path(args.recommended_output).write_text( - json.dumps(recommended, ensure_ascii=False, indent=2), encoding="utf-8" - ) - print(json.dumps(summary, ensure_ascii=False, indent=2)) - - -if __name__ == "__main__": - main() diff --git a/LiDAR_RTK_Direct_Calibration/data/README.md b/data/README.md similarity index 100% rename from LiDAR_RTK_Direct_Calibration/data/README.md rename to data/README.md diff --git a/requirements.txt b/requirements.txt index 36d6239..9f8e5e8 100644 --- a/requirements.txt +++ b/requirements.txt @@ -1,4 +1,4 @@ numpy>=1.26 scipy>=1.11 open3d>=0.18 -small-gicp==1.0.1 +small-gicp diff --git a/results/01_previous_two_batches/README.md b/results/01_previous_two_batches/README.md deleted file mode 100644 index 7983064..0000000 --- a/results/01_previous_two_batches/README.md +++ /dev/null @@ -1,10 +0,0 @@ -# 历史两批结果 - -第二批 38 站的密集 RTK 数据用于求解;第一批 38 站因 RTK 约 10 秒一条,仅作辅助检查。最终部署值: - -```text -translation_m = [1.297759692, -0.000067331, 0.720497835] -RPY_deg_xyz = [-0.785151146, 1.202660822, -0.835510053] -``` - -共识估计使用 39 个运动对,AX RMS 约 `0.07985 m / 0.96118°`。第一批辅助检查 22 对约 `0.06067 m / 1.00298°`。`final_extrinsic_deployment.json` 是唯一建议直接交给下游的部署 JSON;其余文件用于审计和复现。 diff --git a/results/01_previous_two_batches/common/ground_planes_batch2.csv b/results/01_previous_two_batches/common/ground_planes_batch2.csv deleted file mode 100644 index 9d84bc2..0000000 --- a/results/01_previous_two_batches/common/ground_planes_batch2.csv +++ /dev/null @@ -1,39 +0,0 @@ -time,nx,ny,nz,d,inliers,rms_m,frame_counter -1784279335.9505181,-0.05361540190749781,-0.028612066826359885,0.9981516609765378,0.9970438972044271,1413,0.014218123000381944,190 -1784279429.4466305,-0.020242124527498212,-0.021859763099327908,0.999556105054566,0.9527601103226121,1403,0.012533257614588953,1125 -1784279517.5427606,-0.025255763366701406,-0.019499239847777874,0.9994908334057517,0.9627800728846587,1377,0.013484126577744504,2006 -1784279605.2394407,-0.01384716564355861,-0.022470612380854543,0.9996516031012351,0.9522772824995122,1451,0.012466425277627606,2883 -1784279701.2360666,-0.01555857544224011,-0.0217686215576034,0.999641964828253,0.9563364194973247,1538,0.012300341594741273,3843 -1784279817.2306573,-0.011087527873671243,-0.020924555502825015,0.9997195755323889,0.9578164603891901,1449,0.011989950419186364,5003 -1784280797.6884267,-0.02596647147549029,-0.017803282998918958,0.999504269862602,0.9413409925183257,1070,0.01285544119037058,1175 -1784280931.5831878,-0.015374876237213071,-0.006972433892068898,0.9998574890184657,0.9529924610673387,1231,0.012386720372038787,2514 -1784281027.8795433,-0.018194511282557984,-0.007436316920549397,0.9998068118140855,0.9473391457135313,994,0.013690484345080097,3477 -1784281119.375541,-0.031030924482729524,-0.005127874296086657,0.9995052709370525,0.9424388693848053,1050,0.012540091408749102,4392 -1784281219.2718523,0.010887801537886658,0.029801594631508527,0.9994965336283518,1.0385701101629785,1314,0.012779819581803468,5391 -1784281326.268232,-0.0096362623873578,0.012819044946118371,0.9998713989978268,0.9312224966475169,1290,0.014104946182144612,6461 -1784281406.9641902,0.0003902542885943621,0.08032748256370953,0.9967684501661191,1.1034060039993756,1292,0.010758148594815282,7268 -1784281474.3615055,-0.03105566487178763,0.07564589746567012,0.9966510140846617,1.0327196422481995,1815,0.011041719572931458,7942 -1784281630.3553114,-0.08580403119897857,-0.004531705446499283,0.9963017273274953,0.9450482405407393,2217,0.013149265194066527,9502 -1784281794.7491786,-0.0338374639041254,-0.01961931634157733,0.9992347614363835,0.9452222296717823,1260,0.01201022023689137,11146 -1784281908.3446162,-0.021893307599930106,-0.01424087221046337,0.9996588821398128,0.9576567371739861,1494,0.01236191966907317,12282 -1784282032.5400162,-0.0158344231842381,-0.012467864421327742,0.9997968910729789,0.9463865980851461,1636,0.010787373185908479,13524 -1784282152.7353525,-0.018682494816813326,-0.008766064442460298,0.9997870375743079,0.9483840866729998,2240,0.01283360827008306,14726 -1784282248.831164,-0.023968085422919984,0.0010098337757014242,0.9997122141481043,0.9229733966918622,2063,0.01198166200322995,15687 -1784282392.325837,-0.03491854849921791,-0.007495342405346995,0.999362053918866,0.9445161886424389,2063,0.012487104595673213,17122 -1784282521.1221898,-0.033279977268402205,-0.021263918239006526,0.9992198401223525,0.9241543379566599,1765,0.012696796680589562,18410 -1784282614.418045,-0.02206065096269162,-0.02672916533917316,0.9993992592549654,0.9465522302118663,1961,0.013512740981540523,19343 -1784282682.8141525,-0.02081301783029168,-0.01579943764964285,0.9996585397318182,0.9449041973558906,1859,0.012396974052191898,20027 -1784282765.6112185,-0.004508281075411156,-0.014008591413946636,0.9998917115209738,0.950099620414229,2036,0.011293042628447103,20855 -1784282827.209564,-0.01736207184562764,-0.0031377437424165654,0.999844344398384,0.9426007877012084,1748,0.010719044572619517,21471 -1784282910.2059953,-0.021125469928628078,-0.014448226693694841,0.9996724279811374,0.9542841605935083,2168,0.013339960186967582,22301 -1784282963.3037353,-0.006457463553009421,-0.02032265008628933,0.9997726196780605,0.963795839330157,2091,0.012167595789322305,22832 -1784283066.8004546,-0.025064234285691236,-0.029087411217067063,0.9992625814411152,0.9318734965466619,1864,0.012746549021992943,23867 -1784283133.8969557,-0.016700078063969132,-0.04176715532503475,0.9989877937836437,0.9264060770827569,1908,0.01109353135053672,24538 -1784283183.2952216,-0.01653688679373809,-0.017415882722786116,0.9997115676054555,0.9575547004867051,2007,0.012534093025107626,25032 -1784283245.892713,-0.025847980338270828,-0.0153447484376825,0.9995481082008092,0.9578045061243852,1561,0.012070094021521557,25658 -1784283298.8906527,-0.021273542761096498,-0.005573033066936611,0.9997581595970231,0.9467349945273356,2032,0.012236068644419621,26188 -1784283360.3892086,-0.039281329759085375,-0.01627781426001628,0.9990955959743164,0.9222774871766527,1808,0.013038192231074228,26803 -1784283421.0858324,-0.03317220277295649,-0.00229990918740887,0.9994470047886079,0.920634362486867,1708,0.012670933440544421,27410 -1784283483.1839027,-0.025661097999728377,-0.014377994766167732,0.9995672970420513,0.9594288765988624,2042,0.012797258981502222,28031 -1784283558.880709,-0.02901405273913087,-0.038144166153403075,0.998850943500637,0.9554734954630025,1768,0.012270678438066111,28788 -1784283636.4777331,-0.03570548009769577,-0.0034801149872434093,0.9993562965682804,0.9414430863966106,1632,0.012966623651022222,29564 diff --git a/results/01_previous_two_batches/comparison_summary.json b/results/01_previous_two_batches/comparison_summary.json deleted file mode 100644 index ffab318..0000000 --- a/results/01_previous_two_batches/comparison_summary.json +++ /dev/null @@ -1,79 +0,0 @@ -{ - "recommended_backend": "open3d_gicp", - "selection_reason": "The two X estimates agree closely; Open3D has lower second-batch AX residual, better B loop closure, and lower first-batch auxiliary residual.", - "coordinate_convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame", - "measured_extrinsic_used_as_initial": false, - "second_batch_role": "estimation (dense RTK)", - "first_batch_role": "auxiliary check only (sparse RTK)", - "backend_difference": { - "translation_m": 0.00181035475331947, - "rotation_deg": 0.06312194455789993 - }, - "open3d_gicp": { - "translation_m": [ - 1.2978831677200011, - -0.0030997734098957433, - 0.7217892226151688 - ], - "rotation_rpy_deg_xyz": [ - -0.7572070226288585, - 1.1460424368859559, - -0.8797812288284186 - ], - "estimation_pairs": 66, - "estimation_translation_rms_m": 0.10017183831403174, - "estimation_rotation_rms_deg": 1.011529772202344, - "bootstrap_std": [ - 0.0020832827985508263, - 0.002063603632322515, - 0.001427746471392659, - 0.07576290622767821, - 0.06304875844333606, - 0.07843172452171372 - ], - "initial_B_loop_closure": { - "count": 106, - "translation_rms_m": 0.020350848901853437, - "translation_p95_m": 0.04464367942375473, - "rotation_rms_deg": 0.2674546762953808, - "rotation_p95_deg": 0.5761692075739222 - }, - "batch1_auxiliary_pairs": 41, - "batch1_auxiliary_translation_rms_m": 0.06627076507951374, - "batch1_auxiliary_rotation_rms_deg": 1.0783402768758907 - }, - "small_gicp": { - "translation_m": [ - 1.2996301155160686, - -0.0035647011612625953, - 0.7218861757826791 - ], - "rotation_rpy_deg_xyz": [ - -0.7871563544979889, - 1.1414557494228486, - -0.9357571721886107 - ], - "estimation_pairs": 80, - "estimation_translation_rms_m": 0.11870623426762615, - "estimation_rotation_rms_deg": 1.135091439337232, - "bootstrap_std": [ - 0.0017068433472663032, - 0.0019214288447692426, - 0.0013180801706094514, - 0.06849719260762097, - 0.05792635838163369, - 0.062093058432709465 - ], - "initial_B_loop_closure": { - "count": 252, - "translation_rms_m": 0.06356464456110195, - "translation_p95_m": 0.12253135158224471, - "rotation_rms_deg": 0.7286536542725655, - "rotation_p95_deg": 1.4911215410143956 - }, - "batch1_auxiliary_pairs": 36, - "batch1_auxiliary_translation_rms_m": 0.07402020402512643, - "batch1_auxiliary_rotation_rms_deg": 1.1492603033421918 - }, - "important_limit": "Backend agreement is strong, but AX rotation RMS remains about one degree. This is not a centimetre-grade absolute certification." -} diff --git a/results/01_previous_two_batches/consensus/B_batch1_consensus.consensus.json b/results/01_previous_two_batches/consensus/B_batch1_consensus.consensus.json deleted file mode 100644 index 87d1d02..0000000 --- a/results/01_previous_two_batches/consensus/B_batch1_consensus.consensus.json +++ /dev/null @@ -1,328 +0,0 @@ -{ - "selection_is_X_independent": true, - "B_source": "Open3D; small_gicp is used only as an agreement gate", - "max_translation_m": 0.05, - "max_rotation_deg": 0.5, - "input_open3d_pairs": 41, - "accepted_pairs": 22, - "pairs": [ - { - "i": 0, - "j": 1, - "open3d_small_translation_m": 0.04084575096493436, - "open3d_small_rotation_deg": 0.8091245488258404, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 0, - "j": 3, - "open3d_small_translation_m": 0.007440836728606337, - "open3d_small_rotation_deg": 0.14377171116926005, - "accepted": true, - "reason": "" - }, - { - "i": 1, - "j": 2, - "open3d_small_translation_m": 0.012040931709501762, - "open3d_small_rotation_deg": 0.09198739647809913, - "accepted": true, - "reason": "" - }, - { - "i": 2, - "j": 3, - "open3d_small_translation_m": 0.020167802344555865, - "open3d_small_rotation_deg": 0.10088741778579047, - "accepted": true, - "reason": "" - }, - { - "i": 2, - "j": 5, - "open3d_small_translation_m": 0.05126263142175136, - "open3d_small_rotation_deg": 1.129023564517054, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 3, - "j": 4, - "open3d_small_translation_m": 0.008340648580577372, - "open3d_small_rotation_deg": 0.48893802037297335, - "accepted": true, - "reason": "" - }, - { - "i": 3, - "j": 5, - "open3d_small_translation_m": 0.03255543023061846, - "open3d_small_rotation_deg": 0.04924738744939371, - "accepted": true, - "reason": "" - }, - { - "i": 4, - "j": 5, - "open3d_small_translation_m": 0.01717130804559543, - "open3d_small_rotation_deg": 0.18948013657322885, - "accepted": true, - "reason": "" - }, - { - "i": 5, - "j": 6, - "open3d_small_translation_m": 0.00790599819083906, - "open3d_small_rotation_deg": 0.1334214273599749, - "accepted": true, - "reason": "" - }, - { - "i": 6, - "j": 7, - "open3d_small_translation_m": 0.02785621409489221, - "open3d_small_rotation_deg": 0.4203987393515618, - "accepted": true, - "reason": "" - }, - { - "i": 6, - "j": 9, - "open3d_small_translation_m": 0.012940492880990915, - "open3d_small_rotation_deg": 0.16985420735800236, - "accepted": true, - "reason": "" - }, - { - "i": 11, - "j": 12, - "open3d_small_translation_m": 0.016762449071916253, - "open3d_small_rotation_deg": 0.43689758943546, - "accepted": true, - "reason": "" - }, - { - "i": 16, - "j": 17, - "open3d_small_translation_m": 0.038512603544217365, - "open3d_small_rotation_deg": 1.3958733432618273, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 16, - "j": 18, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 17, - "j": 18, - "open3d_small_translation_m": 0.04386909360158492, - "open3d_small_rotation_deg": 0.49818041971185584, - "accepted": true, - "reason": "" - }, - { - "i": 18, - "j": 19, - "open3d_small_translation_m": 0.02904786593904068, - "open3d_small_rotation_deg": 0.6456312776257432, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 18, - "j": 20, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 18, - "j": 21, - "open3d_small_translation_m": 0.06690824468510452, - "open3d_small_rotation_deg": 0.5787554058174607, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 19, - "j": 20, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 20, - "j": 21, - "open3d_small_translation_m": 0.02975935281075696, - "open3d_small_rotation_deg": 0.36957453812106744, - "accepted": true, - "reason": "" - }, - { - "i": 20, - "j": 22, - "open3d_small_translation_m": 0.01187767303223306, - "open3d_small_rotation_deg": 0.11119975547992203, - "accepted": true, - "reason": "" - }, - { - "i": 20, - "j": 23, - "open3d_small_translation_m": 0.02085962034691778, - "open3d_small_rotation_deg": 0.14906239098917923, - "accepted": true, - "reason": "" - }, - { - "i": 21, - "j": 22, - "open3d_small_translation_m": 0.07344207054217174, - "open3d_small_rotation_deg": 0.4720715999477229, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 21, - "j": 24, - "open3d_small_translation_m": 0.003446026826977358, - "open3d_small_rotation_deg": 0.06718280580638468, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 23, - "open3d_small_translation_m": 0.0038695246290457396, - "open3d_small_rotation_deg": 0.19583405427516354, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 24, - "open3d_small_translation_m": 0.008952357752471345, - "open3d_small_rotation_deg": 0.2129847177606736, - "accepted": true, - "reason": "" - }, - { - "i": 23, - "j": 24, - "open3d_small_translation_m": 0.0569515146956438, - "open3d_small_rotation_deg": 0.6801187045572974, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 24, - "j": 25, - "open3d_small_translation_m": 0.025823784600755004, - "open3d_small_rotation_deg": 0.7451009005368011, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 24, - "j": 26, - "open3d_small_translation_m": 0.005434928313511662, - "open3d_small_rotation_deg": 0.38110259637848837, - "accepted": true, - "reason": "" - }, - { - "i": 25, - "j": 26, - "open3d_small_translation_m": 0.032394639661318274, - "open3d_small_rotation_deg": 0.6672581993183133, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 27, - "j": 28, - "open3d_small_translation_m": 0.03319908369315011, - "open3d_small_rotation_deg": 0.3374096789165904, - "accepted": true, - "reason": "" - }, - { - "i": 27, - "j": 29, - "open3d_small_translation_m": 0.064122224643194, - "open3d_small_rotation_deg": 0.3369642063017735, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 28, - "j": 29, - "open3d_small_translation_m": 0.04054098962864038, - "open3d_small_rotation_deg": 0.6304817774750828, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 30, - "j": 31, - "open3d_small_translation_m": 0.06429006702815496, - "open3d_small_rotation_deg": 0.6364945448655926, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 30, - "j": 33, - "open3d_small_translation_m": 0.02846544971259277, - "open3d_small_rotation_deg": 0.5396634629075986, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 31, - "j": 33, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 33, - "j": 34, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 33, - "j": 35, - "open3d_small_translation_m": 0.012003505646551895, - "open3d_small_rotation_deg": 0.2900810668840737, - "accepted": true, - "reason": "" - }, - { - "i": 34, - "j": 35, - "open3d_small_translation_m": 0.034420937161804874, - "open3d_small_rotation_deg": 0.3929515224293036, - "accepted": true, - "reason": "" - }, - { - "i": 34, - "j": 37, - "open3d_small_translation_m": 0.017073125816226477, - "open3d_small_rotation_deg": 0.5761893617071098, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 35, - "j": 36, - "open3d_small_translation_m": 0.009761763696948316, - "open3d_small_rotation_deg": 0.47958651768297733, - "accepted": true, - "reason": "" - } - ] -} diff --git a/results/01_previous_two_batches/consensus/B_batch1_consensus.npz b/results/01_previous_two_batches/consensus/B_batch1_consensus.npz deleted file mode 100644 index 22e8a79..0000000 Binary files a/results/01_previous_two_batches/consensus/B_batch1_consensus.npz and /dev/null differ diff --git a/results/01_previous_two_batches/consensus/B_batch2_consensus.consensus.json b/results/01_previous_two_batches/consensus/B_batch2_consensus.consensus.json deleted file mode 100644 index d1c5393..0000000 --- a/results/01_previous_two_batches/consensus/B_batch2_consensus.consensus.json +++ /dev/null @@ -1,530 +0,0 @@ -{ - "selection_is_X_independent": true, - "B_source": "Open3D; small_gicp is used only as an agreement gate", - "max_translation_m": 0.05, - "max_rotation_deg": 0.5, - "input_open3d_pairs": 66, - "accepted_pairs": 39, - "pairs": [ - { - "i": 0, - "j": 1, - "open3d_small_translation_m": 0.014112857127352833, - "open3d_small_rotation_deg": 0.9322795088817045, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 0, - "j": 2, - "open3d_small_translation_m": 0.04048559177128157, - "open3d_small_rotation_deg": 0.13828514886662066, - "accepted": true, - "reason": "" - }, - { - "i": 0, - "j": 3, - "open3d_small_translation_m": 0.043319730028129194, - "open3d_small_rotation_deg": 0.18606836567929377, - "accepted": true, - "reason": "" - }, - { - "i": 1, - "j": 2, - "open3d_small_translation_m": 0.027224756971621137, - "open3d_small_rotation_deg": 0.11107273153325639, - "accepted": true, - "reason": "" - }, - { - "i": 1, - "j": 3, - "open3d_small_translation_m": 0.04006763116408136, - "open3d_small_rotation_deg": 0.3402294071905194, - "accepted": true, - "reason": "" - }, - { - "i": 1, - "j": 4, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 2, - "j": 3, - "open3d_small_translation_m": 0.01124849125851201, - "open3d_small_rotation_deg": 0.08934477097506471, - "accepted": true, - "reason": "" - }, - { - "i": 2, - "j": 4, - "open3d_small_translation_m": 0.03581057712566857, - "open3d_small_rotation_deg": 0.47251701196497253, - "accepted": true, - "reason": "" - }, - { - "i": 2, - "j": 5, - "open3d_small_translation_m": 0.08528072944363045, - "open3d_small_rotation_deg": 1.2141759174965312, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 3, - "j": 4, - "open3d_small_translation_m": 0.0075101104952604815, - "open3d_small_rotation_deg": 0.18179062115813846, - "accepted": true, - "reason": "" - }, - { - "i": 3, - "j": 5, - "open3d_small_translation_m": 0.024397939276152487, - "open3d_small_rotation_deg": 0.3105330721864524, - "accepted": true, - "reason": "" - }, - { - "i": 4, - "j": 5, - "open3d_small_translation_m": 0.020705651033865183, - "open3d_small_rotation_deg": 0.1233418901694322, - "accepted": true, - "reason": "" - }, - { - "i": 4, - "j": 7, - "open3d_small_translation_m": 0.020920545183303704, - "open3d_small_rotation_deg": 0.7722300773846386, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 5, - "j": 7, - "open3d_small_translation_m": 0.04282503694424416, - "open3d_small_rotation_deg": 0.5633825712787606, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 5, - "j": 8, - "open3d_small_translation_m": 0.11029404203405435, - "open3d_small_rotation_deg": 0.5325792081092059, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 6, - "j": 7, - "open3d_small_translation_m": 0.03271497478931517, - "open3d_small_rotation_deg": 0.31987628752295666, - "accepted": true, - "reason": "" - }, - { - "i": 6, - "j": 8, - "open3d_small_translation_m": 0.07284151111110872, - "open3d_small_rotation_deg": 1.4450826858938794, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 7, - "j": 8, - "open3d_small_translation_m": 0.09279358525836445, - "open3d_small_rotation_deg": 0.19167684909579139, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 7, - "j": 9, - "open3d_small_translation_m": 0.012050834357664957, - "open3d_small_rotation_deg": 0.4077277697131033, - "accepted": true, - "reason": "" - }, - { - "i": 7, - "j": 10, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 8, - "j": 9, - "open3d_small_translation_m": 0.026603663511016604, - "open3d_small_rotation_deg": 0.3213901608387603, - "accepted": true, - "reason": "" - }, - { - "i": 8, - "j": 10, - "open3d_small_translation_m": 0.029568992143279488, - "open3d_small_rotation_deg": 0.42606536158015423, - "accepted": true, - "reason": "" - }, - { - "i": 9, - "j": 10, - "open3d_small_translation_m": 0.03641531538812563, - "open3d_small_rotation_deg": 0.20836252860025806, - "accepted": true, - "reason": "" - }, - { - "i": 10, - "j": 11, - "open3d_small_translation_m": 0.013655861114026318, - "open3d_small_rotation_deg": 0.7320732922437044, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 11, - "j": 12, - "open3d_small_translation_m": 0.015611342863539268, - "open3d_small_rotation_deg": 0.5694244139356097, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 11, - "j": 13, - "open3d_small_translation_m": 0.08667727215031616, - "open3d_small_rotation_deg": 0.8576430944387251, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 11, - "j": 14, - "open3d_small_translation_m": 0.013212394743280101, - "open3d_small_rotation_deg": 0.5395038717718552, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 12, - "j": 13, - "open3d_small_translation_m": 0.05511305334837847, - "open3d_small_rotation_deg": 1.2808633685978204, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 12, - "j": 14, - "open3d_small_translation_m": 0.01673887890907281, - "open3d_small_rotation_deg": 0.4590349395304042, - "accepted": true, - "reason": "" - }, - { - "i": 12, - "j": 15, - "open3d_small_translation_m": 0.09777961576971127, - "open3d_small_rotation_deg": 0.6299487235133375, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 13, - "j": 14, - "open3d_small_translation_m": 0.03968493416626958, - "open3d_small_rotation_deg": 1.39604879980664, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 13, - "j": 15, - "open3d_small_translation_m": 0.04654254454408651, - "open3d_small_rotation_deg": 0.19549226846654652, - "accepted": true, - "reason": "" - }, - { - "i": 13, - "j": 16, - "open3d_small_translation_m": 0.016539968897939728, - "open3d_small_rotation_deg": 0.5036637170277819, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 14, - "j": 15, - "open3d_small_translation_m": 0.08740655127874042, - "open3d_small_rotation_deg": 0.9024809168777701, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 14, - "j": 16, - "open3d_small_translation_m": 0.007961162148769676, - "open3d_small_rotation_deg": 0.3128279997254769, - "accepted": true, - "reason": "" - }, - { - "i": 15, - "j": 16, - "open3d_small_translation_m": 0.05660525597010978, - "open3d_small_rotation_deg": 0.3498659583909866, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 17, - "j": 18, - "open3d_small_translation_m": 0.012632921988089662, - "open3d_small_rotation_deg": 0.23041873752448738, - "accepted": true, - "reason": "" - }, - { - "i": 18, - "j": 19, - "open3d_small_translation_m": 0.02031854418240709, - "open3d_small_rotation_deg": 0.10632729898220249, - "accepted": true, - "reason": "" - }, - { - "i": 20, - "j": 21, - "open3d_small_translation_m": 0.013503153993963056, - "open3d_small_rotation_deg": 0.17004359316703027, - "accepted": true, - "reason": "" - }, - { - "i": 21, - "j": 22, - "open3d_small_translation_m": 0.06340422221619042, - "open3d_small_rotation_deg": 0.5794375484544898, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 22, - "j": 23, - "open3d_small_translation_m": 0.0058706045875484576, - "open3d_small_rotation_deg": 0.09261171568609482, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 24, - "open3d_small_translation_m": 0.035452027277204735, - "open3d_small_rotation_deg": 0.344137196022356, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 25, - "open3d_small_translation_m": 0.016505964730377052, - "open3d_small_rotation_deg": 0.2843410430726553, - "accepted": true, - "reason": "" - }, - { - "i": 23, - "j": 24, - "open3d_small_translation_m": 0.00794618091675699, - "open3d_small_rotation_deg": 0.3391363354920984, - "accepted": true, - "reason": "" - }, - { - "i": 24, - "j": 25, - "open3d_small_translation_m": 0.005640140207369355, - "open3d_small_rotation_deg": 0.40156498371331323, - "accepted": true, - "reason": "" - }, - { - "i": 24, - "j": 26, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 24, - "j": 27, - "open3d_small_translation_m": 0.0748996904677792, - "open3d_small_rotation_deg": 0.13727707305657308, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 25, - "j": 26, - "open3d_small_translation_m": 0.03081891880529517, - "open3d_small_rotation_deg": 0.36020242073965086, - "accepted": true, - "reason": "" - }, - { - "i": 25, - "j": 27, - "open3d_small_translation_m": 0.021168896509812032, - "open3d_small_rotation_deg": 0.14597845760153952, - "accepted": true, - "reason": "" - }, - { - "i": 26, - "j": 27, - "open3d_small_translation_m": 0.01536711683556009, - "open3d_small_rotation_deg": 0.4140655889201126, - "accepted": true, - "reason": "" - }, - { - "i": 26, - "j": 28, - "open3d_small_translation_m": 0.00692948322087535, - "open3d_small_rotation_deg": 0.2580451959432504, - "accepted": true, - "reason": "" - }, - { - "i": 26, - "j": 29, - "open3d_small_translation_m": 0.004434517854459698, - "open3d_small_rotation_deg": 0.3814089109711929, - "accepted": true, - "reason": "" - }, - { - "i": 27, - "j": 28, - "open3d_small_translation_m": 0.050137370980335605, - "open3d_small_rotation_deg": 0.3289989587699738, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 27, - "j": 29, - "open3d_small_translation_m": 0.05401741972476896, - "open3d_small_rotation_deg": 0.5027869137341908, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 27, - "j": 30, - "open3d_small_translation_m": 0.014426259697867812, - "open3d_small_rotation_deg": 0.10299393098756303, - "accepted": true, - "reason": "" - }, - { - "i": 29, - "j": 30, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 30, - "j": 31, - "open3d_small_translation_m": 0.017329917379458395, - "open3d_small_rotation_deg": 0.22398877826738903, - "accepted": true, - "reason": "" - }, - { - "i": 30, - "j": 32, - "open3d_small_translation_m": 0.014715435206511102, - "open3d_small_rotation_deg": 0.11629038752134123, - "accepted": true, - "reason": "" - }, - { - "i": 31, - "j": 32, - "open3d_small_translation_m": 0.015582546369975235, - "open3d_small_rotation_deg": 0.5827409440555306, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 32, - "j": 33, - "open3d_small_translation_m": 0.008274791505352475, - "open3d_small_rotation_deg": 0.16710510386507704, - "accepted": true, - "reason": "" - }, - { - "i": 32, - "j": 34, - "open3d_small_translation_m": 0.009965535682972116, - "open3d_small_rotation_deg": 0.25506349516996085, - "accepted": true, - "reason": "" - }, - { - "i": 32, - "j": 35, - "open3d_small_translation_m": 0.013983188091914709, - "open3d_small_rotation_deg": 0.4717278366783201, - "accepted": true, - "reason": "" - }, - { - "i": 33, - "j": 34, - "open3d_small_translation_m": 0.01464477642231769, - "open3d_small_rotation_deg": 0.23054883080903335, - "accepted": true, - "reason": "" - }, - { - "i": 33, - "j": 35, - "open3d_small_translation_m": 0.02477884255472743, - "open3d_small_rotation_deg": 0.21737771891740004, - "accepted": true, - "reason": "" - }, - { - "i": 34, - "j": 35, - "open3d_small_translation_m": 0.05732289121946012, - "open3d_small_rotation_deg": 0.16151350666473244, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 35, - "j": 36, - "open3d_small_translation_m": 0.01157700515581757, - "open3d_small_rotation_deg": 0.49328772540040833, - "accepted": true, - "reason": "" - } - ] -} diff --git a/results/01_previous_two_batches/consensus/B_batch2_consensus.npz b/results/01_previous_two_batches/consensus/B_batch2_consensus.npz deleted file mode 100644 index c88bcda..0000000 Binary files a/results/01_previous_two_batches/consensus/B_batch2_consensus.npz and /dev/null differ diff --git a/results/01_previous_two_batches/consensus/batch1_auxiliary_check.json b/results/01_previous_two_batches/consensus/batch1_auxiliary_check.json deleted file mode 100644 index 7e5874d..0000000 --- a/results/01_previous_two_batches/consensus/batch1_auxiliary_check.json +++ /dev/null @@ -1,179 +0,0 @@ -{ - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": true, - "note": "No AX residual was used to select these pairs", - "stations": 38, - "metrics": { - "pairs": 22, - "translation_m": { - "rms": 0.06067269746244947, - "median": 0.042680679229823305, - "p90": 0.090942947259565, - "p95": 0.10135707648063859, - "max": 0.14643003383767556 - }, - "rotation_deg": { - "rms": 1.002984942285067, - "median": 0.707406938077333, - "p90": 1.573355332434981, - "p95": 1.7757584051966382, - "max": 1.8710372365314285 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.048343805321803004, - "rotation_deg": 0.6668376546913104, - "i": 0, - "j": 3 - }, - { - "pair_index": 1, - "translation_m": 0.0423483041362295, - "rotation_deg": 1.7859688557628564, - "i": 1, - "j": 2 - }, - { - "pair_index": 2, - "translation_m": 0.02300615185240312, - "rotation_deg": 1.8710372365314285, - "i": 2, - "j": 3 - }, - { - "pair_index": 3, - "translation_m": 0.09155252198785023, - "rotation_deg": 0.6733340854508988, - "i": 3, - "j": 4 - }, - { - "pair_index": 4, - "translation_m": 0.03158045213093479, - "rotation_deg": 0.2310116592109763, - "i": 3, - "j": 5 - }, - { - "pair_index": 5, - "translation_m": 0.07825296974670955, - "rotation_deg": 0.7403656481818025, - "i": 4, - "j": 5 - }, - { - "pair_index": 6, - "translation_m": 0.03623050776977002, - "rotation_deg": 0.29976499205053747, - "i": 5, - "j": 6 - }, - { - "pair_index": 7, - "translation_m": 0.017322045818086197, - "rotation_deg": 1.0428116209013618, - "i": 6, - "j": 7 - }, - { - "pair_index": 8, - "translation_m": 0.037890995883582496, - "rotation_deg": 0.5003524050137443, - "i": 6, - "j": 9 - }, - { - "pair_index": 9, - "translation_m": 0.055811972906268326, - "rotation_deg": 0.9711899476368479, - "i": 11, - "j": 12 - }, - { - "pair_index": 10, - "translation_m": 0.10187310566446957, - "rotation_deg": 0.48973592009907335, - "i": 17, - "j": 18 - }, - { - "pair_index": 11, - "translation_m": 0.0304808468879537, - "rotation_deg": 1.3239848803794854, - "i": 20, - "j": 21 - }, - { - "pair_index": 12, - "translation_m": 0.04462456608967399, - "rotation_deg": 0.2812977599385038, - "i": 20, - "j": 22 - }, - { - "pair_index": 13, - "translation_m": 0.03611683783839059, - "rotation_deg": 0.7096084761069892, - "i": 20, - "j": 23 - }, - { - "pair_index": 14, - "translation_m": 0.07267248449673575, - "rotation_deg": 0.6614151319251916, - "i": 21, - "j": 24 - }, - { - "pair_index": 15, - "translation_m": 0.04417889214251473, - "rotation_deg": 0.537164719319421, - "i": 22, - "j": 23 - }, - { - "pair_index": 16, - "translation_m": 0.020100630082582033, - "rotation_deg": 1.4866116021028042, - "i": 22, - "j": 24 - }, - { - "pair_index": 17, - "translation_m": 0.04301305432341711, - "rotation_deg": 0.7052054000476768, - "i": 24, - "j": 26 - }, - { - "pair_index": 18, - "translation_m": 0.0344886352240195, - "rotation_deg": 1.4977147244033493, - "i": 27, - "j": 28 - }, - { - "pair_index": 19, - "translation_m": 0.14643003383767556, - "rotation_deg": 0.527768319167481, - "i": 33, - "j": 35 - }, - { - "pair_index": 20, - "translation_m": 0.08545677470499786, - "rotation_deg": 0.7336105280022196, - "i": 34, - "j": 35 - }, - { - "pair_index": 21, - "translation_m": 0.025212589301108413, - "rotation_deg": 1.5817598444384953, - "i": 35, - "j": 36 - } - ] - } -} diff --git a/results/01_previous_two_batches/consensus/extrinsic_batch2_consensus.json b/results/01_previous_two_batches/consensus/extrinsic_batch2_consensus.json deleted file mode 100644 index 3279d38..0000000 --- a/results/01_previous_two_batches/consensus/extrinsic_batch2_consensus.json +++ /dev/null @@ -1,399 +0,0 @@ -{ - "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.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ], - "quaternion_xyzw": [ - -0.0067746045444860015, - 0.010544431385358818, - -0.0072186568687935965, - 0.9998953998759249 - ], - "matrix_4x4": [ - [ - 0.9996734119195402, - 0.014292934887214408, - 0.021184463964312037, - 1.2977596922478565 - ], - [ - -0.01457867229834346, - 0.9998039914525529, - 0.013395558575925315, - -6.733076264476427e-05 - ], - [ - -0.020988849781798404, - -0.013700025104115046, - 0.9996858394000506, - 0.7204978345266887 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 38, - "pairs": 39, - "residuals": { - "pairs": 39, - "translation_m": { - "rms": 0.07984780651249465, - "median": 0.05392926910429046, - "p90": 0.11822807898946641, - "p95": 0.14420733112402187, - "max": 0.2330103519747209 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011372, - "p90": 1.422624767604584, - "p95": 1.4793113785217964, - "max": 1.7237415928660533 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.1353760421849012, - "rotation_deg": 0.5166365681634405 - }, - { - "pair_index": 1, - "translation_m": 0.11487543918383647, - "rotation_deg": 0.5717221816616095 - }, - { - "pair_index": 2, - "translation_m": 0.06210064976174764, - "rotation_deg": 0.4402983357286552 - }, - { - "pair_index": 3, - "translation_m": 0.054355548674489614, - "rotation_deg": 0.5821611725015269 - }, - { - "pair_index": 4, - "translation_m": 0.02391657882546618, - "rotation_deg": 0.32738975448002894 - }, - { - "pair_index": 5, - "translation_m": 0.07775220171630512, - "rotation_deg": 0.8706732532310371 - }, - { - "pair_index": 6, - "translation_m": 0.06265840922697155, - "rotation_deg": 0.8002960897011372 - }, - { - "pair_index": 7, - "translation_m": 0.09282561040685418, - "rotation_deg": 1.0484294819479303 - }, - { - "pair_index": 8, - "translation_m": 0.034474807960716856, - "rotation_deg": 0.40941928556312257 - }, - { - "pair_index": 9, - "translation_m": 0.13163863821198593, - "rotation_deg": 1.1065820279922887 - }, - { - "pair_index": 10, - "translation_m": 0.0018609877360485794, - "rotation_deg": 0.6081452332544832 - }, - { - "pair_index": 11, - "translation_m": 0.06488404028756532, - "rotation_deg": 0.05192051717362457 - }, - { - "pair_index": 12, - "translation_m": 0.1147488321233841, - "rotation_deg": 0.9937108406424444 - }, - { - "pair_index": 13, - "translation_m": 0.05392926910429046, - "rotation_deg": 0.9700546737541248 - }, - { - "pair_index": 14, - "translation_m": 0.02302185790244543, - "rotation_deg": 1.6149869587730064 - }, - { - "pair_index": 15, - "translation_m": 0.2330103519747209, - "rotation_deg": 0.5939965715201481 - }, - { - "pair_index": 16, - "translation_m": 0.2236889315761065, - "rotation_deg": 1.1151964340680336 - }, - { - "pair_index": 17, - "translation_m": 0.04090994021171706, - "rotation_deg": 0.7785618518380144 - }, - { - "pair_index": 18, - "translation_m": 0.054652520003134704, - "rotation_deg": 1.124375763416717 - }, - { - "pair_index": 19, - "translation_m": 0.04547500551567543, - "rotation_deg": 0.6556954445211121 - }, - { - "pair_index": 20, - "translation_m": 0.02484690940972022, - "rotation_deg": 1.7237415928660533 - }, - { - "pair_index": 21, - "translation_m": 0.056832852413462566, - "rotation_deg": 0.5831473606925555 - }, - { - "pair_index": 22, - "translation_m": 0.03998842216950218, - "rotation_deg": 1.124691549503354 - }, - { - "pair_index": 23, - "translation_m": 0.052224143195848054, - "rotation_deg": 1.1184574012171749 - }, - { - "pair_index": 24, - "translation_m": 0.06305629062353875, - "rotation_deg": 0.5252019728243343 - }, - { - "pair_index": 25, - "translation_m": 0.0552093328283033, - "rotation_deg": 0.08705258513790126 - }, - { - "pair_index": 26, - "translation_m": 0.08502281683725502, - "rotation_deg": 0.6459827373704314 - }, - { - "pair_index": 27, - "translation_m": 0.03727269737723399, - "rotation_deg": 0.7631660358041192 - }, - { - "pair_index": 28, - "translation_m": 0.04543722819346571, - "rotation_deg": 1.4218618784137362 - }, - { - "pair_index": 29, - "translation_m": 0.02559982081388642, - "rotation_deg": 1.388947601285772 - }, - { - "pair_index": 30, - "translation_m": 0.01827234061769129, - "rotation_deg": 1.206866980510853 - }, - { - "pair_index": 31, - "translation_m": 0.06863732394647468, - "rotation_deg": 1.4642363140494394 - }, - { - "pair_index": 32, - "translation_m": 0.04770629220585725, - "rotation_deg": 0.6244903967618446 - }, - { - "pair_index": 33, - "translation_m": 0.027074935362624366, - "rotation_deg": 1.3688430767407767 - }, - { - "pair_index": 34, - "translation_m": 0.03301156138156032, - "rotation_deg": 1.4256763243679755 - }, - { - "pair_index": 35, - "translation_m": 0.054240160043693975, - "rotation_deg": 0.6486412679040612 - }, - { - "pair_index": 36, - "translation_m": 0.021992835671895014, - "rotation_deg": 0.23769553016909395 - }, - { - "pair_index": 37, - "translation_m": 0.031890552923517286, - "rotation_deg": 1.0832171246083164 - }, - { - "pair_index": 38, - "translation_m": 0.025286131886091672, - "rotation_deg": 1.2215923174512224 - } - ] - } - }, - "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.0061384486036208784, - 0.006616582082990767, - 0.004372364137893693 - ], - "rotation_deg": [ - 0.06746979098802125, - 0.05919345389075773, - 0.16157711056486687 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.965138763120991, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 152.7941369486616, - "success": true, - "translation_m": 5.01999140559543e-10, - "rotation_deg": 7.693408441139155e-09 - }, - { - "cost": 152.79413694866156, - "success": true, - "translation_m": 1.7788160768171148e-10, - "rotation_deg": 3.2213546311649044e-09 - }, - { - "cost": 152.7941369486616, - "success": true, - "translation_m": 2.04052729806573e-10, - "rotation_deg": 5.128825141169912e-09 - }, - { - "cost": 152.79413694866287, - "success": true, - "translation_m": 3.6987521890593636e-09, - "rotation_deg": 1.471926437983498e-07 - }, - { - "cost": 152.79413694866153, - "success": true, - "translation_m": 3.0367491381779985e-10, - "rotation_deg": 3.27791256123688e-09 - }, - { - "cost": 152.79413694866173, - "success": true, - "translation_m": 6.928454212106221e-10, - "rotation_deg": 2.8875952395155353e-08 - }, - { - "cost": 152.79413694866153, - "success": true, - "translation_m": 1.9628898247072475e-10, - "rotation_deg": 3.769277991759282e-09 - }, - { - "cost": 152.79413694866167, - "success": true, - "translation_m": 1.8108640246434077e-09, - "rotation_deg": 5.6964069970580913e-08 - }, - { - "cost": 152.79413694866145, - "success": true, - "translation_m": 0.0, - "rotation_deg": 0.0 - }, - { - "cost": 152.7941369486631, - "success": true, - "translation_m": 3.8878373558477815e-09, - "rotation_deg": 1.567977862312646e-07 - }, - { - "cost": 152.79413694866162, - "success": true, - "translation_m": 1.928688225276107e-09, - "rotation_deg": 6.007537452298471e-08 - }, - { - "cost": 152.79413694866165, - "success": true, - "translation_m": 6.380398519737792e-10, - "rotation_deg": 2.6596239917974983e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.003223574650236103, - 0.003334649335095665, - 0.0016858977028131694, - 0.0980155224808408, - 0.07461769310738842, - 0.11886090357304822 - ], - "p025": [ - 1.2916920074190312, - -0.005413227092587022, - 0.7171569502776788, - -0.9695959273616203, - 1.066246526462818, - -1.100751980508544 - ], - "p975": [ - 1.3034038047298853, - 0.007138524793626496, - 0.7235834879340349, - -0.6076030002143074, - 1.3517461178267727, - -0.6468477685453492 - ] - } -} diff --git a/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.csv b/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.csv deleted file mode 100644 index f8fd637..0000000 --- a/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.csv +++ /dev/null @@ -1,19 +0,0 @@ -label,roll_correction_deg,pitch_correction_deg,yaw_correction_deg,selected_pair_translation_cm,selected_pair_rotation_deg,all_pair_translation_rms_m,all_pair_rotation_rms_deg,normalized_global_rms,normalized_global_rms_change,improved_pairs,worsened_pairs,global_consistency_signal,ground_normal_tilt_rms_deg,ground_height_rms_m -baseline,0.0,0.0,0.0,13.53760421849012,0.5166365681634405,0.07984780651249465,0.961176171904301,2.4991413356769443,0.0,0,0,False,1.6662748432297785,0.03471396517121729 -pitch_+0.100,0.0,0.1,0.0,13.322368374959654,0.4851311566747633,0.07937622701088871,0.9709178397492695,2.508178616440067,0.009037280763122713,17,22,False,1.661255702204205,0.03471396517121729 -pitch_+0.200,0.0,0.2,0.0,13.107741962217032,0.45594025406310634,0.07905894857986535,0.991843015836615,2.536757223795175,0.03761588811823069,17,22,False,1.6622470214176333,0.03471396517121729 -pitch_+0.300,0.0,0.3,0.0,12.89375489636804,0.4295360884271374,0.07889765995849754,1.0232658257505307,2.5842267894606974,0.0850854537837531,16,23,False,1.669238092496052,0.034713965171217276 -pitch_+0.000_roll_-0.200,-0.2,0.0,0.0,13.395035432680281,0.501501180601739,0.08136434456273667,0.9671396098919116,2.5277457796497282,0.028604443972783944,12,27,False,1.7107124278398285,0.034713965171217304 -pitch_+0.000_roll_-0.100,-0.1,0.0,0.0,13.466127879921094,0.5071126466746416,0.08054864611850543,0.958376027630505,2.503831503507573,0.004690167830628589,13,26,False,1.685676496509504,0.034713965171217304 -pitch_+0.000_roll_+0.100,0.1,0.0,0.0,13.609457775458583,0.5298619890141043,0.07926481666577584,0.9754404878748625,2.5137822192795105,0.014640883602566213,23,16,False,1.652705907802981,0.034713965171217304 -pitch_+0.100_roll_-0.200,-0.2,0.1,0.0,13.180263465884618,0.4689801268726104,0.08100204146829142,0.9768217811391146,2.5379628557651293,0.03882152008818496,14,25,False,1.7058242505297496,0.034713965171217304 -pitch_+0.100_roll_-0.100,-0.1,0.1,0.0,13.251119920699841,0.47497594758710626,0.08013195956996022,0.9681458624297539,2.5134991588556583,0.014357823178714035,17,22,False,1.6807154082401394,0.03471396517121729 -pitch_+0.100_roll_+0.100,0.1,0.1,0.0,13.394001942784334,0.4991919434350986,0.07873808044179886,0.9850410981186302,2.5221217227950565,0.022980387118112233,19,20,False,1.6476453039285432,0.0347139651712173 -pitch_+0.200_roll_-0.200,-0.2,0.2,0.0,12.966120616418092,0.43871598020210434,0.08079188106279227,0.9976230703529106,2.567477045713792,0.0683357100368478,15,24,False,1.7067898021773054,0.034713965171217304 -pitch_+0.200_roll_-0.100,-0.1,0.2,0.0,13.036731063691272,0.44511961856905025,0.07986863254178682,0.989129669887256,2.5426579402355864,0.04351660455864215,19,20,False,1.6816953294526065,0.03471396517121731 -pitch_+0.200_roll_+0.100,0.1,0.2,0.0,13.179146202690733,0.4708734484159498,0.07836629319834118,1.0056724288764685,2.5499055866185576,0.0507642509416133,19,20,False,1.648644705864238,0.034713965171217304 -pitch_+0.300_roll_-0.200,-0.2,0.3,0.0,12.752638042306833,0.4112074527490782,0.08073488194995813,1.0288692761236073,2.6156330810711834,0.11649174539423912,15,24,False,1.7135991876939975,0.03471396517121731 -pitch_+0.300_roll_-0.100,-0.1,0.3,0.0,12.822991835578721,0.41803263983275235,0.07976001272785865,1.020636005744607,2.5906476559016074,0.0915063202246631,16,23,False,1.6886059172123598,0.0347139651712173 -pitch_+0.300_roll_+0.100,0.1,0.3,0.0,12.964919880829425,0.44535539842024163,0.07815149226179761,1.036676092226784,2.596507573236926,0.09736623755998153,18,21,False,1.6556931398905776,0.034713965171217304 -yaw_-0.200_diagnostic,0.0,0.0,-0.2,13.607478813867315,0.5166365681634414,0.08024771376258277,0.961176171904301,2.5042597228312786,0.005118387154334325,18,21,False,1.6662748432297787,0.0347139651712173 -yaw_+0.200_diagnostic,0.0,0.0,0.2,13.479715314434312,0.5166365681634427,0.08028135387591602,0.961176171904301,2.5046909681249,0.005549632447955588,13,26,False,1.6662748432297787,0.0347139651712173 diff --git a/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.json b/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.json deleted file mode 100644 index 4da1000..0000000 --- a/results/01_previous_two_batches/diagnostics/consensus_pair0_left_rpy_scan.json +++ /dev/null @@ -1,17439 +0,0 @@ -{ - "schema_version": 1, - "diagnostic_only": true, - "extrinsic_was_modified": false, - "equation": "delta_ij = B_ij^-1 * (X^-1 * A_ij * X)", - "correction_convention": "X_test = DeltaR_body * X; DeltaR uses fixed body xyz RPY axes", - "component_frame": "delta translation/RPY components are in station-j LiDAR coordinates, not screen axes", - "selection_rule": "Never accept a correction from selected_pair alone. Require improvement over all refined pairs, directional consistency across pairs, acceptable ground constraints, and independent visual review. This script never overwrites X.", - "pairs_file": "results\\01_previous_two_batches\\consensus\\B_batch2_consensus.npz", - "extrinsic_file": "results\\01_previous_two_batches\\final_extrinsic_recommended.json", - "stations": 38, - "pairs": 39, - "selected_pair_index": 0, - "selected_pair_stations": [ - 0, - 2 - ], - "normalization": { - "translation_scale_m": 0.05, - "rotation_scale_deg": 0.5 - }, - "z_observability": { - "body_left_z_test_shift_m": 0.1, - "max_predicted_motion_change_translation_m": 9.977540720306595e-16, - "max_predicted_motion_change_rotation_deg": 0.0, - "numerically_unobservable": true, - "note": "AX pairs cannot determine X.z when every A rotation preserves body Z; use ground/external height constraints." - }, - "ranking_by_all_pair_normalized_rms": [ - { - "rank": 1, - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.4991413356769443, - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 39, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - }, - { - "rank": 2, - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.503831503507573, - "normalized_global_rms_change": 0.004690167830628589, - "improved_pairs": 13, - "worsened_pairs": 26, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.02309094892649588, - "global_consistency_signal": false - }, - { - "rank": 3, - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "normalized_global_rms": 2.5042597228312786, - "normalized_global_rms_change": 0.005118387154334325, - "improved_pairs": 18, - "worsened_pairs": 21, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.00023747568828058618, - "global_consistency_signal": false - }, - { - "rank": 4, - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "normalized_global_rms": 2.5046909681249, - "normalized_global_rms_change": 0.005549632447955588, - "improved_pairs": 13, - "worsened_pairs": 26, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.003543965438597585, - "global_consistency_signal": false - }, - { - "rank": 5, - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.508178616440067, - "normalized_global_rms_change": 0.009037280763122713, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004215801948034725, - "global_consistency_signal": false - }, - { - "rank": 6, - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.5134991588556583, - "normalized_global_rms_change": 0.014357823178714035, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.040343980923164935, - "global_consistency_signal": false - }, - { - "rank": 7, - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.5137822192795105, - "normalized_global_rms_change": 0.014640883602566213, - "improved_pairs": 23, - "worsened_pairs": 16, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.01407846496018239, - "global_consistency_signal": false - }, - { - "rank": 8, - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.5221217227950565, - "normalized_global_rms_change": 0.022980387118112233, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0017833859279048347, - "global_consistency_signal": false - }, - { - "rank": 9, - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.5277457796497282, - "normalized_global_rms_change": 0.028604443972783944, - "improved_pairs": 12, - "worsened_pairs": 27, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.05528357443912335, - "global_consistency_signal": false - }, - { - "rank": 10, - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.536757223795175, - "normalized_global_rms_change": 0.03761588811823069, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.02564623883043149, - "global_consistency_signal": false - }, - { - "rank": 11, - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.5379628557651293, - "normalized_global_rms_change": 0.03882152008818496, - "improved_pairs": 14, - "worsened_pairs": 25, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08839405329553651, - "global_consistency_signal": false - }, - { - "rank": 12, - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.5426579402355864, - "normalized_global_rms_change": 0.04351660455864215, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004610571887935899, - "global_consistency_signal": false - }, - { - "rank": 13, - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.5499055866185576, - "normalized_global_rms_change": 0.0507642509416133, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004455671029209851, - "global_consistency_signal": false - }, - { - "rank": 14, - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.567477045713792, - "normalized_global_rms_change": 0.0683357100368478, - "improved_pairs": 15, - "worsened_pairs": 24, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09642312056064384, - "global_consistency_signal": false - }, - { - "rank": 15, - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.5842267894606974, - "normalized_global_rms_change": 0.0850854537837531, - "improved_pairs": 16, - "worsened_pairs": 23, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.054065192130319684, - "global_consistency_signal": false - }, - { - "rank": 16, - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.5906476559016074, - "normalized_global_rms_change": 0.0915063202246631, - "improved_pairs": 16, - "worsened_pairs": 23, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09517752543255265, - "global_consistency_signal": false - }, - { - "rank": 17, - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.596507573236926, - "normalized_global_rms_change": 0.09736623755998153, - "improved_pairs": 18, - "worsened_pairs": 21, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.014333648430353563, - "global_consistency_signal": false - }, - { - "rank": 18, - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.6156330810711834, - "normalized_global_rms_change": 0.11649174539423912, - "improved_pairs": 15, - "worsened_pairs": 24, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10227536531420744, - "global_consistency_signal": false - } - ], - "candidates": [ - { - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07984780651249465, - "median": 0.05392926910429046, - "p90": 0.11822807898946641, - "p95": 0.14420733112402187, - "max": 0.2330103519747209 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011372, - "p90": 1.422624767604584, - "p95": 1.4793113785217964, - "max": 1.7237415928660533 - }, - "normalized_pair_score": { - "rms": 2.4991413356769443, - "median": 2.334619798652635, - "p90": 3.2979848200732014, - "p95": 3.615727919392074, - "max": 4.998934645511607 - }, - "normalized_global_rms": 2.4991413356769443 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02052857396800767, - -0.01428529034535031, - 0.13304578508256934 - ], - "translation_xyz_cm": [ - 2.052857396800767, - -1.428529034535031, - 13.304578508256935 - ], - "translation_norm_m": 0.1353760421849012, - "rotation_rpy_deg_xyz": [ - -0.3191465214425994, - -0.21122341614483142, - -0.346462756418374 - ], - "rotation_angle_deg": 0.5166365681634405, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297785, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02052857396800767, - -0.01428529034535031, - 0.13304578508256934 - ], - "translation_xyz_cm": [ - 2.052857396800767, - -1.428529034535031, - 13.304578508256935 - ], - "translation_norm_m": 0.1353760421849012, - "rotation_rpy_deg_xyz": [ - -0.3191465214425994, - -0.21122341614483142, - -0.346462756418374 - ], - "rotation_angle_deg": 0.5166365681634405, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03273144680100759, - 0.009583887593645146, - 0.10969579762499791 - ], - "translation_xyz_cm": [ - 3.273144680100759, - 0.9583887593645146, - 10.96957976249979 - ], - "translation_norm_m": 0.11487543918383647, - "rotation_rpy_deg_xyz": [ - -0.2783386301425947, - -0.2946203532968976, - -0.4025139229771167 - ], - "rotation_angle_deg": 0.5717221816616095, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03436110047699936, - -0.018260324601735434, - 0.048397996035787025 - ], - "translation_xyz_cm": [ - 3.436110047699936, - -1.8260324601735434, - 4.839799603578703 - ], - "translation_norm_m": 0.06210064976174764, - "rotation_rpy_deg_xyz": [ - 0.2530123443114437, - 0.07856507161125245, - -0.351501336427272 - ], - "rotation_angle_deg": 0.4402983357286552, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04584216322665169, - 0.012536569398787334, - 0.026379085846845066 - ], - "translation_xyz_cm": [ - 4.584216322665169, - 1.2536569398787334, - 2.6379085846845065 - ], - "translation_norm_m": 0.054355548674489614, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940201 - ], - "rotation_angle_deg": 0.5821611725015269, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.005190953532214183, - 0.021323398506183727, - -0.009506283200473876 - ], - "translation_xyz_cm": [ - 0.5190953532214183, - 2.1323398506183726, - -0.9506283200473876 - ], - "translation_norm_m": 0.02391657882546618, - "rotation_rpy_deg_xyz": [ - 0.2526567759620954, - 0.20523572243396423, - -0.03457860688667861 - ], - "rotation_angle_deg": 0.32738975448002894, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03364854084308805, - 0.0012226941252421741, - -0.070083418794606 - ], - "translation_xyz_cm": [ - -3.3648540843088046, - 0.12226941252421741, - -7.0083418794606 - ], - "translation_norm_m": 0.07775220171630512, - "rotation_rpy_deg_xyz": [ - 0.5232134708787115, - 0.45218792670014574, - 0.5310776539185706 - ], - "rotation_angle_deg": 0.8706732532310371, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03198060915260165, - -0.01947511276020042, - -0.05023979367056203 - ], - "translation_xyz_cm": [ - -3.1980609152601644, - -1.947511276020042, - -5.023979367056203 - ], - "translation_norm_m": 0.06265840922697155, - "rotation_rpy_deg_xyz": [ - 0.44639004529749127, - 0.318991530825338, - 0.5838735792541095 - ], - "rotation_angle_deg": 0.8002960897011372, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03925092882946142, - -0.03685914526653261, - -0.07561323920882028 - ], - "translation_xyz_cm": [ - -3.9250928829461422, - -3.685914526653261, - -7.561323920882028 - ], - "translation_norm_m": 0.09282561040685418, - "rotation_rpy_deg_xyz": [ - 0.5870852895990377, - 0.7143924390784686, - 0.4978279478250872 - ], - "rotation_angle_deg": 1.0484294819479303, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013516950439105994, - -0.009882318425277786, - -0.030135431261166214 - ], - "translation_xyz_cm": [ - -1.3516950439105995, - -0.9882318425277786, - -3.0135431261166215 - ], - "translation_norm_m": 0.034474807960716856, - "rotation_rpy_deg_xyz": [ - 0.3047418481958035, - 0.25845828464587195, - -0.08851206912855099 - ], - "rotation_angle_deg": 0.40941928556312257, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.007613001510299977, - 0.016285228367701632, - -0.13040538568372895 - ], - "translation_xyz_cm": [ - 0.7613001510299977, - 1.6285228367701632, - -13.040538568372895 - ], - "translation_norm_m": 0.13163863821198593, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.2904144812930959 - ], - "rotation_angle_deg": 1.1065820279922887, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00046231776291572046, - -0.0010242925377600964, - 0.0014833618698432294 - ], - "translation_xyz_cm": [ - 0.046231776291572046, - -0.10242925377600964, - 0.14833618698432294 - ], - "translation_norm_m": 0.0018609877360485794, - "rotation_rpy_deg_xyz": [ - 0.1196437156776497, - -0.35285794691723626, - -0.4810120163770678 - ], - "rotation_angle_deg": 0.6081452332544832, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009947953803371101, - 0.020779243974916817, - -0.06065640872154629 - ], - "translation_xyz_cm": [ - 0.9947953803371101, - 2.0779243974916817, - -6.065640872154629 - ], - "translation_norm_m": 0.06488404028756532, - "rotation_rpy_deg_xyz": [ - 0.05141503904963397, - 0.00449354092149435, - 0.00566257803508252 - ], - "rotation_angle_deg": 0.05192051717362457, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011720839382669546, - 0.04078765655773409, - -0.10661277348598798 - ], - "translation_xyz_cm": [ - 1.1720839382669546, - 4.078765655773409, - -10.661277348598798 - ], - "translation_norm_m": 0.1147488321233841, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.16652151636587426 - ], - "rotation_angle_deg": 0.9937108406424444, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006342328407356823, - 0.017067540552920146, - -0.05076258460687988 - ], - "translation_xyz_cm": [ - 0.6342328407356823, - 1.7067540552920146, - -5.076258460687988 - ], - "translation_norm_m": 0.05392926910429046, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.16495442440099967 - ], - "rotation_angle_deg": 0.9700546737541248, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.003651031066738808, - 0.009502453304174097, - 0.020648953838683645 - ], - "translation_xyz_cm": [ - -0.3651031066738808, - 0.9502453304174097, - 2.0648953838683646 - ], - "translation_norm_m": 0.02302185790244543, - "rotation_rpy_deg_xyz": [ - -0.0706997048049651, - 1.5418459142259642, - 0.47434907172896096 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0311981451842821, - -0.006193419626776775, - 0.2308292473188145 - ], - "translation_xyz_cm": [ - 3.11981451842821, - -0.6193419626776775, - 23.082924731881448 - ], - "translation_norm_m": 0.2330103519747209, - "rotation_rpy_deg_xyz": [ - 0.16034369761383055, - -0.5134999386071942, - -0.25259308482191567 - ], - "rotation_angle_deg": 0.5939965715201481, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.01280809400838745, - 0.02652544478208263, - 0.22174104630547103 - ], - "translation_xyz_cm": [ - -1.280809400838745, - 2.652544478208263, - 22.174104630547102 - ], - "translation_norm_m": 0.2236889315761065, - "rotation_rpy_deg_xyz": [ - 0.7326830017201678, - -0.4714411171372534, - -0.699149025175759 - ], - "rotation_angle_deg": 1.1151964340680336, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -6.348802272287957e-05, - -0.0034095380069181225, - -0.04076756342947927 - ], - "translation_xyz_cm": [ - -0.006348802272287957, - -0.34095380069181225, - -4.076756342947927 - ], - "translation_norm_m": 0.04090994021171706, - "rotation_rpy_deg_xyz": [ - -0.5190787323237711, - 0.5728926682292592, - 0.08970289125554098 - ], - "rotation_angle_deg": 0.7785618518380144, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0007618573013186136, - 0.027582229992488383, - 0.04717560921479383 - ], - "translation_xyz_cm": [ - -0.07618573013186136, - 2.7582229992488383, - 4.717560921479383 - ], - "translation_norm_m": 0.054652520003134704, - "rotation_rpy_deg_xyz": [ - -0.8380523330945311, - -0.11317732429063847, - -0.7401789685624974 - ], - "rotation_angle_deg": 1.124375763416717, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01339014355257051, - -0.04001543383677619, - -0.016954210012467465 - ], - "translation_xyz_cm": [ - 1.339014355257051, - -4.001543383677619, - -1.6954210012467466 - ], - "translation_norm_m": 0.04547500551567543, - "rotation_rpy_deg_xyz": [ - 0.10326906176616622, - 0.025313967913603432, - -0.6469944518488355 - ], - "rotation_angle_deg": 0.6556954445211121, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.006825491191319699, - -0.011833827708358113, - -0.020754327235084163 - ], - "translation_xyz_cm": [ - 0.6825491191319699, - -1.1833827708358113, - -2.0754327235084165 - ], - "translation_norm_m": 0.02484690940972022, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.1511766857359274 - ], - "rotation_angle_deg": 1.7237415928660533, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.003984245475547654, - 0.004381143887356165, - 0.056523486089229115 - ], - "translation_xyz_cm": [ - 0.3984245475547654, - 0.4381143887356165, - 5.652348608922911 - ], - "translation_norm_m": 0.056832852413462566, - "rotation_rpy_deg_xyz": [ - -0.355025584566797, - -0.4408120377458715, - -0.13900903227030575 - ], - "rotation_angle_deg": 0.5831473606925555, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01300263115987299, - -0.029342601752106012, - 0.023854081683098563 - ], - "translation_xyz_cm": [ - -1.300263115987299, - -2.9342601752106012, - 2.3854081683098562 - ], - "translation_norm_m": 0.03998842216950218, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.21201038202913366 - ], - "rotation_angle_deg": 1.124691549503354, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012279637037453606, - 0.02195120021718555, - 0.04576807245005926 - ], - "translation_xyz_cm": [ - -1.2279637037453606, - 2.195120021718555, - 4.576807245005926 - ], - "translation_norm_m": 0.052224143195848054, - "rotation_rpy_deg_xyz": [ - 0.09546623284033692, - 1.0775827775049782, - -0.28309517022880915 - ], - "rotation_angle_deg": 1.1184574012171749, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.001743350970683899, - -0.02928001457804441, - -0.05581878949693109 - ], - "translation_xyz_cm": [ - -0.1743350970683899, - -2.928001457804441, - -5.581878949693109 - ], - "translation_norm_m": 0.06305629062353875, - "rotation_rpy_deg_xyz": [ - 0.49268288279378014, - 0.15825199914177118, - -0.08908409912480704 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.02099922653299524, - 0.019606439549219146, - -0.04714541806544017 - ], - "translation_xyz_cm": [ - -2.099922653299524, - 1.9606439549219146, - -4.714541806544017 - ], - "translation_norm_m": 0.0552093328283033, - "rotation_rpy_deg_xyz": [ - -0.02108664689711338, - -0.04627392585907875, - 0.07066423048105945 - ], - "rotation_angle_deg": 0.08705258513790126, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03486321758831146, - 0.023776982101818334, - -0.07381118183894142 - ], - "translation_xyz_cm": [ - -3.4863217588311457, - 2.3776982101818334, - -7.3811181838941415 - ], - "translation_norm_m": 0.08502281683725502, - "rotation_rpy_deg_xyz": [ - 0.24098676691704204, - 0.5093600460816013, - 0.31694103112252414 - ], - "rotation_angle_deg": 0.6459827373704314, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009825755543722281, - 0.013969499096951665, - -0.0331294671365258 - ], - "translation_xyz_cm": [ - -0.9825755543722281, - 1.3969499096951665, - -3.31294671365258 - ], - "translation_norm_m": 0.03727269737723399, - "rotation_rpy_deg_xyz": [ - 0.3785440778586856, - 0.6159343431432545, - 0.24648916494074977 - ], - "rotation_angle_deg": 0.7631660358041192, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.004985497717641341, - 0.0014594738069999558, - 0.04513930055527167 - ], - "translation_xyz_cm": [ - 0.49854977176413406, - 0.14594738069999558, - 4.513930055527167 - ], - "translation_norm_m": 0.04543722819346571, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435074547, - -0.2850593933606419 - ], - "rotation_angle_deg": 1.4218618784137362, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.014310358103192033, - 0.009631176068884084, - 0.01891573218756422 - ], - "translation_xyz_cm": [ - -1.4310358103192033, - 0.9631176068884084, - 1.8915732187564218 - ], - "translation_norm_m": 0.02559982081388642, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.39605225228591057 - ], - "rotation_angle_deg": 1.388947601285772, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.004926721987130733, - 0.01081300665837337, - 0.013881092504425818 - ], - "translation_xyz_cm": [ - 0.49267219871307333, - 1.081300665837337, - 1.3881092504425818 - ], - "translation_norm_m": 0.01827234061769129, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781172 - ], - "rotation_angle_deg": 1.206866980510853, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004800114846089443, - 0.039402542738807944, - 0.05599536375195781 - ], - "translation_xyz_cm": [ - -0.48001148460894427, - 3.9402542738807944, - 5.599536375195781 - ], - "translation_norm_m": 0.06863732394647468, - "rotation_rpy_deg_xyz": [ - -1.2295910627015743, - -0.5146874739254865, - 0.6115327195592978 - ], - "rotation_angle_deg": 1.4642363140494394, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.022455666341073766, - 0.022205356741625604, - 0.03575689440074663 - ], - "translation_xyz_cm": [ - 2.2455666341073766, - 2.2205356741625604, - 3.5756894400746626 - ], - "translation_norm_m": 0.04770629220585725, - "rotation_rpy_deg_xyz": [ - -0.31513998336533705, - -0.2141940157510921, - 0.4953590423367671 - ], - "rotation_angle_deg": 0.6244903967618446, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003821333082424605, - -0.0008422271162171202, - 0.026790673598253614 - ], - "translation_xyz_cm": [ - -0.3821333082424605, - -0.08422271162171202, - 2.6790673598253614 - ], - "translation_norm_m": 0.027074935362624366, - "rotation_rpy_deg_xyz": [ - 0.5172047347275824, - -1.243920438445153, - 0.23715544796713608 - ], - "rotation_angle_deg": 1.3688430767407767, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015134357633463047, - 0.004972583641746908, - 0.028913453889094512 - ], - "translation_xyz_cm": [ - -1.5134357633463047, - 0.4972583641746908, - 2.891345388909451 - ], - "translation_norm_m": 0.03301156138156032, - "rotation_rpy_deg_xyz": [ - -0.6182568414692501, - -1.2732199342731065, - 0.17800383183508953 - ], - "rotation_angle_deg": 1.4256763243679755, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0061062182666129505, - 0.01602768262860832, - -0.0514569961191151 - ], - "translation_xyz_cm": [ - 0.610621826661295, - 1.602768262860832, - -5.1456996119115095 - ], - "translation_norm_m": 0.054240160043693975, - "rotation_rpy_deg_xyz": [ - -0.11937661233725202, - -0.6309937842808361, - 0.09193837926716737 - ], - "rotation_angle_deg": 0.6486412679040612, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0053080710713586665, - 0.002196157177062119, - -0.02122936871520257 - ], - "translation_xyz_cm": [ - -0.5308071071358667, - 0.2196157177062119, - -2.122936871520257 - ], - "translation_norm_m": 0.021992835671895014, - "rotation_rpy_deg_xyz": [ - 0.11147341198359811, - -0.20435563963405623, - -0.04827864446295879 - ], - "rotation_angle_deg": 0.23769553016909395, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010102197262432444, - 0.020309199742545747, - -0.022416274937106278 - ], - "translation_xyz_cm": [ - 1.0102197262432444, - 2.0309199742545747, - -2.2416274937106277 - ], - "translation_norm_m": 0.031890552923517286, - "rotation_rpy_deg_xyz": [ - 1.0522317952095894, - 0.21279800583519293, - -0.14258070238539475 - ], - "rotation_angle_deg": 1.0832171246083164, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003715628797124282, - 0.0013204687437722296, - 0.02497676781930607 - ], - "translation_xyz_cm": [ - 0.3715628797124282, - 0.13204687437722296, - 2.497676781930607 - ], - "translation_norm_m": 0.025286131886091672, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334271742 - ], - "rotation_angle_deg": 1.2215923174512224, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 39, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152209554813, - -6.733076264476427e-05, - 0.7182317203430111 - ], - "rotation_rpy_deg_xyz": [ - -0.7866097110824058, - 1.3026501895476275, - -0.8355419388029673 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07937622701088871, - "median": 0.05221778608012503, - "p90": 0.11976925801233426, - "p95": 0.14268268771252177, - "max": 0.23208680477760554 - }, - "rotation_deg": { - "rms": 0.9709178397492695, - "median": 0.8344276259149954, - "p90": 1.460499216579679, - "p95": 1.5182519027389203, - "max": 1.7222843995877888 - }, - "normalized_pair_score": { - "rms": 2.508178616440067, - "median": 2.324595883178269, - "p90": 3.3858677167139657, - "p95": 3.5944328812451745, - "max": 4.905151333505401 - }, - "normalized_global_rms": 2.508178616440067 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02051966594073562, - -0.014923276025446741, - 0.13078527843056897 - ], - "translation_xyz_cm": [ - 2.051966594073562, - -1.4923276025446741, - 13.078527843056897 - ], - "translation_norm_m": 0.13322368374959653, - "rotation_rpy_deg_xyz": [ - -0.27499964252311604, - -0.20023069659911333, - -0.3454035114939882 - ], - "rotation_angle_deg": 0.4851311566747633, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.661255702204205, - "median": 0.7319328700150243, - "p90": 2.3218554814672183, - "p95": 3.880978501442499, - "max": 5.5539133452469 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02051966594073562, - -0.014923276025446741, - 0.13078527843056897 - ], - "translation_xyz_cm": [ - 2.051966594073562, - -1.4923276025446741, - 13.078527843056897 - ], - "translation_norm_m": 0.13322368374959653, - "rotation_rpy_deg_xyz": [ - -0.27499964252311604, - -0.20023069659911333, - -0.3454035114939882 - ], - "rotation_angle_deg": 0.4851311566747633, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03295136881139227, - 0.008617322556370821, - 0.1071756913550131 - ], - "translation_xyz_cm": [ - 3.2951368811392268, - 0.8617322556370821, - 10.71756913550131 - ], - "translation_norm_m": 0.11245745760957769, - "rotation_rpy_deg_xyz": [ - -0.21216311907327182, - -0.26828285027110155, - -0.400818110870366 - ], - "rotation_angle_deg": 0.5272965606703562, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034337379664961976, - -0.018542182852037237, - 0.0471252642060859 - ], - "translation_xyz_cm": [ - 3.4337379664961976, - -1.8542182852037237, - 4.71252642060859 - ], - "translation_norm_m": 0.06118544527636886, - "rotation_rpy_deg_xyz": [ - 0.27564597154663273, - 0.0814914904988837, - -0.35095270635227116 - ], - "rotation_angle_deg": 0.4537914571352452, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04594209861596066, - 0.011921598454077476, - 0.024908745166160175 - ], - "translation_xyz_cm": [ - 4.594209861596066, - 1.1921598454077476, - 2.4908745166160173 - ], - "translation_norm_m": 0.053602672701010205, - "rotation_rpy_deg_xyz": [ - 0.4075306811169571, - 0.2594733494501883, - -0.3833101993023162 - ], - "rotation_angle_deg": 0.6172849060984689, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00523573679978292, - 0.02098993006877678, - -0.009625001957190535 - ], - "translation_xyz_cm": [ - 0.523573679978292, - 2.098993006877678, - -0.9625001957190534 - ], - "translation_norm_m": 0.02367764276283985, - "rotation_rpy_deg_xyz": [ - 0.2792119562023699, - 0.20921882814903586, - -0.033924760434783256 - ], - "rotation_angle_deg": 0.3505955247931428, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03321621732171365, - 0.00040588091060411724, - -0.07059760975127063 - ], - "translation_xyz_cm": [ - -3.321621732171365, - 0.040588091060411724, - -7.059760975127063 - ], - "translation_norm_m": 0.07802246045254921, - "rotation_rpy_deg_xyz": [ - 0.5930310698175939, - 0.481990798394924, - 0.5333036360882121 - ], - "rotation_angle_deg": 0.9304552261138788, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03174089547398258, - -0.02004014194491016, - -0.050603077140599535 - ], - "translation_xyz_cm": [ - -3.174089547398258, - -2.004014194491016, - -5.060307714059953 - ], - "translation_norm_m": 0.0630060564609459, - "rotation_rpy_deg_xyz": [ - 0.49496347730467044, - 0.3323723766499313, - 0.5852293196132937 - ], - "rotation_angle_deg": 0.8344276259149954, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038754942189076574, - -0.037690113430767724, - -0.07623097682966877 - ], - "translation_xyz_cm": [ - -3.8754942189076576, - -3.769011343076772, - -7.623097682966877 - ], - "translation_norm_m": 0.0934540102023894, - "rotation_rpy_deg_xyz": [ - 0.6603821300742498, - 0.7478965916725878, - 0.5002551436195283 - ], - "rotation_angle_deg": 1.114174265455696, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013423979465021843, - -0.010267484351008827, - -0.030196651376784105 - ], - "translation_xyz_cm": [ - -1.3423979465021842, - -1.0267484351008827, - -3.0196651376784107 - ], - "translation_norm_m": 0.034604366977978036, - "rotation_rpy_deg_xyz": [ - 0.336131850082815, - 0.2639837018538619, - -0.08771892131972028 - ], - "rotation_angle_deg": 0.4364656210971346, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.007969648944450514, - 0.01586724522081695, - -0.133300045644409 - ], - "translation_xyz_cm": [ - 0.7969648944450514, - 1.586724522081695, - -13.3300045644409 - ], - "translation_norm_m": 0.13447745886949547, - "rotation_rpy_deg_xyz": [ - -0.7990426814538194, - 0.6665122976755382, - 0.29130516749756297 - ], - "rotation_angle_deg": 1.0817877508079645, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0007753480461729634, - -0.0018746231610113906, - 0.0021012096647769346 - ], - "translation_xyz_cm": [ - 0.07753480461729634, - -0.18746231610113906, - 0.21012096647769346 - ], - "translation_norm_m": 0.002920694890579392, - "rotation_rpy_deg_xyz": [ - 0.18635037892170195, - -0.3260387051895817, - -0.4791133906880013 - ], - "rotation_angle_deg": 0.6083324473724265, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010117055046520385, - 0.020530943807697155, - -0.06146207983047336 - ], - "translation_xyz_cm": [ - 1.0117055046520385, - 2.0530943807697155, - -6.146207983047336 - ], - "translation_norm_m": 0.0655855297572309, - "rotation_rpy_deg_xyz": [ - 0.07441835191959958, - 0.007514475391252907, - 0.006210389018937291 - ], - "rotation_angle_deg": 0.0750537590458637, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01212909412596097, - 0.04027826130641543, - -0.10853949724003133 - ], - "translation_xyz_cm": [ - 1.212909412596097, - 4.027826130641543, - -10.853949724003133 - ], - "translation_norm_m": 0.11640565157801863, - "rotation_rpy_deg_xyz": [ - -0.9050550997692758, - -0.21062912431314335, - 0.16755718166353725 - ], - "rotation_angle_deg": 0.9439310075445936, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006513283956986249, - 0.016746887839297453, - -0.051679826017548475 - ], - "translation_xyz_cm": [ - 0.6513283956986249, - 1.6746887839297453, - -5.167982601754847 - ], - "translation_norm_m": 0.05471458249324784, - "rotation_rpy_deg_xyz": [ - -0.9242360847641867, - -0.08473452237526666, - 0.16554781300183535 - ], - "rotation_angle_deg": 0.9426406124065511, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.002237634641799824, - 0.008254025600278325, - 0.01694195478575204 - ], - "translation_xyz_cm": [ - -0.22376346417998239, - 0.8254025600278325, - 1.6941954785752038 - ], - "translation_norm_m": 0.018978034127978036, - "rotation_rpy_deg_xyz": [ - 0.027107288441695736, - 1.65452244628629, - 0.4779898666505666 - ], - "rotation_angle_deg": 1.7222843995877888, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.033085430211094224, - -0.00772591694151048, - 0.2295864749218431 - ], - "translation_xyz_cm": [ - 3.3085430211094224, - -0.772591694151048, - 22.95864749218431 - ], - "translation_norm_m": 0.23208680477760554, - "rotation_rpy_deg_xyz": [ - 0.252165863350938, - -0.3776720919769801, - -0.24823185418507174 - ], - "rotation_angle_deg": 0.5171360805623124, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012219975766302404, - 0.02518037496651271, - 0.21471318630795244 - ], - "translation_xyz_cm": [ - -1.2219975766302404, - 2.518037496651271, - 21.471318630795245 - ], - "translation_norm_m": 0.21652974729975716, - "rotation_rpy_deg_xyz": [ - 0.8186168933082603, - -0.4200459673784277, - -0.6958675384757913 - ], - "rotation_angle_deg": 1.1517874172683882, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00039028101324112274, - -0.004244709256594703, - -0.04487265144198564 - ], - "translation_xyz_cm": [ - 0.039028101324112274, - -0.4244709256594703, - -4.487265144198564 - ], - "translation_norm_m": 0.04507465721862179, - "rotation_rpy_deg_xyz": [ - -0.4487972006148934, - 0.6032064639501636, - 0.09139918033367782 - ], - "rotation_angle_deg": 0.7576679009812031, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.00041424810922041644, - 0.026864782968873957, - 0.04098611416278038 - ], - "translation_xyz_cm": [ - -0.041424810922041644, - 2.6864782968873957, - 4.098611416278038 - ], - "translation_norm_m": 0.049007649603150315, - "rotation_rpy_deg_xyz": [ - -0.7823419582087989, - -0.09522388778360807, - -0.7389683499726251 - ], - "rotation_angle_deg": 1.0808111897380877, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013863041074912097, - -0.04097294278766839, - -0.016259471775116358 - ], - "translation_xyz_cm": [ - 1.3863041074912097, - -4.097294278766839, - -1.6259471775116356 - ], - "translation_norm_m": 0.04620969996583025, - "rotation_rpy_deg_xyz": [ - 0.18029387575019123, - 0.06332105940999891, - -0.6446945932449862 - ], - "rotation_angle_deg": 0.6725136623168326, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.006773453670679608, - -0.012432659839920202, - -0.014361138260317763 - ], - "translation_xyz_cm": [ - 0.6773453670679608, - -1.2432659839920202, - -1.4361138260317763 - ], - "translation_norm_m": 0.020166630790887465, - "rotation_rpy_deg_xyz": [ - -1.3165597183166375, - -1.022088859606694, - 0.15217388298814216 - ], - "rotation_angle_deg": 1.6725819815357155, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.004880349390126826, - 0.003049741772324935, - 0.05732746794052886 - ], - "translation_xyz_cm": [ - 0.4880349390126826, - 0.3049741772324935, - 5.732746794052886 - ], - "translation_norm_m": 0.057615599584834136, - "rotation_rpy_deg_xyz": [ - -0.25947399506936814, - -0.36494574516350675, - -0.13628532271320348 - ], - "rotation_angle_deg": 0.4683062669355568, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.010314327084092856, - -0.0294789375686772, - 0.01867830279389164 - ], - "translation_xyz_cm": [ - -1.0314327084092856, - -2.94789375686772, - 1.8678302793891641 - ], - "translation_norm_m": 0.036390549578646375, - "rotation_rpy_deg_xyz": [ - 1.0767619755284152, - -0.13234391573093487, - -0.20515862979025176 - ], - "rotation_angle_deg": 1.1038610850821526, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012007348585915345, - 0.02108765803839452, - 0.0406260959681395 - ], - "translation_xyz_cm": [ - -1.2007348585915345, - 2.108765803839452, - 4.06260959681395 - ], - "translation_norm_m": 0.047321722445621404, - "rotation_rpy_deg_xyz": [ - 0.1636261283576874, - 1.1057380728049826, - -0.28115514026609795 - ], - "rotation_angle_deg": 1.1529800073040937, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004303917880057462, - -0.030431288495687103, - -0.0576385471772721 - ], - "translation_xyz_cm": [ - -0.04303917880057462, - -3.0431288495687103, - -5.7638547177272095 - ], - "translation_norm_m": 0.06518014020624337, - "rotation_rpy_deg_xyz": [ - 0.5911935925908259, - 0.26035862854617775, - -0.08456304865131221 - ], - "rotation_angle_deg": 0.6516700744745407, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.020244558201732987, - 0.01851393698804904, - -0.04443072341892369 - ], - "translation_xyz_cm": [ - -2.0244558201732987, - 1.851393698804904, - -4.443072341892369 - ], - "translation_norm_m": 0.05221778608012503, - "rotation_rpy_deg_xyz": [ - 0.06990196894477091, - 0.015609813596195071, - 0.07352927378554952 - ], - "rotation_angle_deg": 0.10264065763694455, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03344177297623341, - 0.022657094817768342, - -0.07271034569665377 - ], - "translation_xyz_cm": [ - -3.344177297623341, - 2.265709481776834, - -7.271034569665377 - ], - "translation_norm_m": 0.08317746387515178, - "rotation_rpy_deg_xyz": [ - 0.338381643721089, - 0.6245163780718037, - 0.3212323512722692 - ], - "rotation_angle_deg": 0.7787976666017864, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009598209236728883, - 0.013365669792407497, - -0.03457396615463748 - ], - "translation_xyz_cm": [ - -0.9598209236728883, - 1.3365669792407497, - -3.457396615463748 - ], - "translation_norm_m": 0.03829002331174167, - "rotation_rpy_deg_xyz": [ - 0.43003972350458614, - 0.6310663681198572, - 0.24792955123508 - ], - "rotation_angle_deg": 0.8021663667768609, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0067942052548271015, - 0.00019725215510701943, - 0.050179257447018455 - ], - "translation_xyz_cm": [ - 0.6794205254827101, - 0.019725215510701943, - 5.017925744701845 - ], - "translation_norm_m": 0.050637515849334194, - "rotation_rpy_deg_xyz": [ - 1.4268409924314462, - -0.214567689883574, - -0.2774144397796576 - ], - "rotation_angle_deg": 1.4688037653678097, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011945132246371948, - 0.009100958460405595, - 0.01562431254980888 - ], - "translation_xyz_cm": [ - -1.1945132246371948, - 0.9100958460405595, - 1.562431254980888 - ], - "translation_norm_m": 0.02167101224990329, - "rotation_rpy_deg_xyz": [ - 1.384509151500671, - 0.22140376968280798, - 0.4040854758953925 - ], - "rotation_angle_deg": 1.4584230793826463, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.007262290145911621, - 0.010105120729610118, - 0.012114259065773028 - ], - "translation_xyz_cm": [ - 0.7262290145911621, - 1.0105120729610118, - 1.2114259065773028 - ], - "translation_norm_m": 0.017366910946857106, - "rotation_rpy_deg_xyz": [ - 0.9035135934762457, - 0.8741098204206807, - -0.4974323568110727 - ], - "rotation_angle_deg": 1.354501617940593, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004910158924756658, - 0.04010014182667543, - 0.06254041177546328 - ], - "translation_xyz_cm": [ - -0.4910158924756658, - 4.010014182667543, - 6.254041177546328 - ], - "translation_norm_m": 0.07445424192234018, - "rotation_rpy_deg_xyz": [ - -1.2786779623618896, - -0.5026242861886394, - 0.6103604643866053 - ], - "rotation_angle_deg": 1.5011041162059429, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02314757907141196, - 0.02343298995790466, - 0.04282352956059339 - ], - "translation_xyz_cm": [ - 2.314757907141196, - 2.343298995790466, - 4.282352956059339 - ], - "translation_norm_m": 0.054025643163793484, - "rotation_rpy_deg_xyz": [ - -0.41234774915652744, - -0.14294196684435448, - 0.49375825121481526 - ], - "rotation_angle_deg": 0.6585978079878347, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003674432424048746, - -0.0001118141021488328, - 0.029407677492396075 - ], - "translation_xyz_cm": [ - -0.3674432424048746, - -0.01118141021488328, - 2.9407677492396074 - ], - "translation_norm_m": 0.029636555999797257, - "rotation_rpy_deg_xyz": [ - 0.45451664837675126, - -1.222941734881918, - 0.23624942935701784 - ], - "rotation_angle_deg": 1.3267506740417352, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01396027436975622, - 0.006222939178173126, - 0.029651784943137027 - ], - "translation_xyz_cm": [ - -1.396027436975622, - 0.6222939178173126, - 2.9651784943137027 - ], - "translation_norm_m": 0.03335929529843462, - "rotation_rpy_deg_xyz": [ - -0.7195756743216479, - -1.1770200306448997, - 0.17598332254564697 - ], - "rotation_angle_deg": 1.3897893060956639, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007893373743384391, - 0.0170801559921141, - -0.0499133514293227 - ], - "translation_xyz_cm": [ - 0.7893373743384391, - 1.7080155992114099, - -4.99133514293227 - ], - "translation_norm_m": 0.053342100902333905, - "rotation_rpy_deg_xyz": [ - -0.2082641615943626, - -0.48249627837492387, - 0.09160682521358601 - ], - "rotation_angle_deg": 0.5332986524627087, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00484721201223981, - 0.003150703424940282, - -0.02155231831609281 - ], - "translation_xyz_cm": [ - -0.484721201223981, - 0.3150703424940282, - -2.155231831609281 - ], - "translation_norm_m": 0.022314229118697376, - "rotation_rpy_deg_xyz": [ - 0.0343272360026619, - -0.1696745516127692, - -0.04944597788558324 - ], - "rotation_angle_deg": 0.1800213546372699, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011210970051067193, - 0.021594279532552108, - -0.025233683986500333 - ], - "translation_xyz_cm": [ - 1.1210970051067193, - 2.1594279532552108, - -2.5233683986500335 - ], - "translation_norm_m": 0.03505335312843106, - "rotation_rpy_deg_xyz": [ - 0.9522016451020995, - 0.2961266316996025, - -0.14216772784271955 - ], - "rotation_angle_deg": 1.0076148796229685, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00386251604912613, - 0.001949884093898735, - 0.022715246811351883 - ], - "translation_xyz_cm": [ - 0.386251604912613, - 0.1949884093898735, - 2.271524681135188 - ], - "translation_norm_m": 0.023123657061763135, - "rotation_rpy_deg_xyz": [ - 1.1702100166322438, - -0.13126702440410526, - 0.021263078443348474 - ], - "rotation_angle_deg": 1.1777652672084904, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.009037280763122713, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004215801948034725, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667926374616, - -6.733076264476427e-05, - 0.7159634183009542 - ], - "rotation_rpy_deg_xyz": [ - -0.7880683915167217, - 1.4026395561702687, - -0.8355763723005772 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07905894857986535, - "median": 0.052560851221245895, - "p90": 0.12067618592139934, - "p95": 0.14452636883190614, - "max": 0.2311840693001604 - }, - "rotation_deg": { - "rms": 0.991843015836615, - "median": 0.8942834455537132, - "p90": 1.5352021067140798, - "p95": 1.5558463214326372, - "max": 1.8354867077719332 - }, - "normalized_pair_score": { - "rms": 2.536757223795175, - "median": 2.3064759298743756, - "p90": 3.4681563659419603, - "p95": 3.78734353057968, - "max": 4.822051856878565 - }, - "normalized_global_rms": 2.536757223795175 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02051386609078487, - -0.015557731269103314, - 0.12852403755941622 - ], - "translation_xyz_cm": [ - 2.051386609078487, - -1.5557731269103314, - 12.852403755941621 - ], - "translation_norm_m": 0.13107741962217032, - "rotation_rpy_deg_xyz": [ - -0.23085461037466334, - -0.1892395167107833, - -0.34425847295643264 - ], - "rotation_angle_deg": 0.45594025406310634, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6622470214176333, - "median": 0.7148339614213655, - "p90": 2.277662858258894, - "p95": 3.7960285397867324, - "max": 5.579952273463167 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02051386609078487, - -0.015557731269103314, - 0.12852403755941622 - ], - "translation_xyz_cm": [ - 2.051386609078487, - -1.5557731269103314, - 12.852403755941621 - ], - "translation_norm_m": 0.13107741962217032, - "rotation_rpy_deg_xyz": [ - -0.23085461037466334, - -0.1892395167107833, - -0.34425847295643264 - ], - "rotation_angle_deg": 0.45594025406310634, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03317356173120256, - 0.007656347154861409, - 0.10465418458912298 - ], - "translation_xyz_cm": [ - 3.317356173120256, - 0.7656347154861409, - 10.465418458912298 - ], - "translation_norm_m": 0.11005272918789379, - "rotation_rpy_deg_xyz": [ - -0.14599012279428614, - -0.24194855514443686, - -0.39897572135183684 - ], - "rotation_angle_deg": 0.48916199208322036, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034315702266682124, - -0.018822621239843296, - 0.04585233573735856 - ], - "translation_xyz_cm": [ - 3.4315702266682124, - -1.8822621239843296, - 4.585233573735856 - ], - "translation_norm_m": 0.06028511578296604, - "rotation_rpy_deg_xyz": [ - 0.29827878592034196, - 0.08441695101341982, - -0.3503633556539259 - ], - "rotation_angle_deg": 0.46797926816769986, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04604377855535169, - 0.01130976188872379, - 0.02343780378703015 - ], - "translation_xyz_cm": [ - 4.604377855535169, - 1.130976188872379, - 2.343780378703015 - ], - "translation_norm_m": 0.05288923240124797, - "rotation_rpy_deg_xyz": [ - 0.4551234260787949, - 0.2722961805773567, - -0.3819135203806907 - ], - "rotation_angle_deg": 0.654190424558848, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.005280556020637331, - 0.020657570998644598, - -0.009743870388128897 - ], - "translation_xyz_cm": [ - 0.528055602063733, - 2.06575709986446, - -0.9743870388128897 - ], - "translation_norm_m": 0.023442749872653306, - "rotation_rpy_deg_xyz": [ - 0.30576630385284326, - 0.21320075582506187, - -0.033222636548297234 - ], - "rotation_angle_deg": 0.37428468642621304, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03278447612247977, - -0.0004075247415502581, - -0.07111288041521424 - ], - "translation_xyz_cm": [ - -3.278447612247977, - -0.04075247415502581, - -7.111288041521425 - ], - "translation_norm_m": 0.078307277516135, - "rotation_rpy_deg_xyz": [ - 0.6628484170307424, - 0.5117879098996975, - 0.5356884781929347 - ], - "rotation_angle_deg": 0.9925106000585615, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.031501191670756615, - -0.02060293004202665, - -0.05096674515342746 - ], - "translation_xyz_cm": [ - -3.1501191670756614, - -2.060293004202665, - -5.0966745153427455 - ], - "translation_norm_m": 0.0633594106232753, - "rotation_rpy_deg_xyz": [ - 0.5435358614810986, - 0.3457501290985925, - 0.5866814782604906 - ], - "rotation_angle_deg": 0.8701957998948366, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03825960448656847, - -0.03851737131448241, - -0.07684988476774919 - ], - "translation_xyz_cm": [ - -3.825960448656847, - -3.8517371314482407, - -7.684988476774919 - ], - "translation_norm_m": 0.09409192323075712, - "rotation_rpy_deg_xyz": [ - 0.7336797523092549, - 0.7813942795317939, - 0.5028538998862719 - ], - "rotation_angle_deg": 1.1818112556504974, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013331130956475284, - -0.01065137270259911, - -0.030258028438431173 - ], - "translation_xyz_cm": [ - -1.3331130956475286, - -1.065137270259911, - -3.0258028438431173 - ], - "translation_norm_m": 0.034737862312026004, - "rotation_rpy_deg_xyz": [ - 0.3675209494419985, - 0.26950759267802527, - -0.08686784275218122 - ], - "rotation_angle_deg": 0.4641140983090535, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008330483302982028, - 0.015453053161794794, - -0.13619464976703227 - ], - "translation_xyz_cm": [ - 0.8330483302982028, - 1.5453053161794794, - -13.619464976703227 - ], - "translation_norm_m": 0.13732143470429917, - "rotation_rpy_deg_xyz": [ - -0.7580488375823727, - 0.6759597444083112, - 0.2922743826800189 - ], - "rotation_angle_deg": 1.0581062857341232, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0010865704909703844, - -0.0027230188507425535, - 0.0027179065495190613 - ], - "translation_xyz_cm": [ - 0.10865704909703844, - -0.27230188507425535, - 0.27179065495190613 - ], - "translation_norm_m": 0.003997809788529906, - "rotation_rpy_deg_xyz": [ - 0.2530544584417354, - -0.29922374883802605, - -0.47706645034059303 - ], - "rotation_angle_deg": 0.6168730042301562, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010287397036085333, - 0.020283896309429283, - -0.06226761744117501 - ], - "translation_xyz_cm": [ - 1.0287397036085333, - 2.0283896309429283, - -6.226761744117501 - ], - "translation_norm_m": 0.06629119978602181, - "rotation_rpy_deg_xyz": [ - 0.09742078560760371, - 0.010534577213690796, - 0.006799628393851377 - ], - "rotation_angle_deg": 0.09822372370385068, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012539725072939212, - 0.039772513627569506, - -0.11046635370708617 - ], - "translation_xyz_cm": [ - 1.2539725072939212, - 3.9772513627569506, - -11.046635370708618 - ], - "translation_norm_m": 0.11807587749620654, - "rotation_rpy_deg_xyz": [ - -0.8561370947705013, - -0.197011797657047, - 0.16869019740490312 - ], - "rotation_angle_deg": 0.8942834455537132, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006685602606380736, - 0.01642780265446897, - -0.052597037760116344 - ], - "translation_xyz_cm": [ - 0.6685602606380736, - 1.642780265446897, - -5.2597037760116345 - ], - "translation_norm_m": 0.05550692176119774, - "rotation_rpy_deg_xyz": [ - -0.8965756924992224, - -0.08040776004941842, - 0.16619167435301652 - ], - "rotation_angle_deg": 0.9152722241962895, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0008296286350282234, - 0.0070158673086409, - 0.0132301208348873 - ], - "translation_xyz_cm": [ - -0.08296286350282234, - 0.70158673086409, - 1.32301208348873 - ], - "translation_norm_m": 0.014998225730740083, - "rotation_rpy_deg_xyz": [ - 0.12492842538259899, - 1.7671899909217683, - 0.4819967397813876 - ], - "rotation_angle_deg": 1.8354867077719332, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03496676207083993, - -0.009252557031327546, - 0.22833700890754582 - ], - "translation_xyz_cm": [ - 3.496676207083993, - -0.9252557031327546, - 22.83370089075458 - ], - "translation_norm_m": 0.2311840693001604, - "rotation_rpy_deg_xyz": [ - 0.34399258199885535, - -0.24185450898088387, - -0.24348928201794912 - ], - "rotation_angle_deg": 0.4855486904235825, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011627702039361587, - 0.023849425576336625, - 0.2076827467065669 - ], - "translation_xyz_cm": [ - -1.1627702039361587, - 2.3849425576336625, - 20.768274670656687 - ], - "translation_norm_m": 0.20937077598036793, - "rotation_rpy_deg_xyz": [ - 0.9045487157526158, - -0.36866014915602674, - -0.6923577331820522 - ], - "rotation_angle_deg": 1.1955893292198465, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0008478451143869026, - -0.005071945899447261, - -0.04897886756205033 - ], - "translation_xyz_cm": [ - 0.08478451143869026, - -0.5071945899447261, - -4.897886756205033 - ], - "translation_norm_m": 0.04924807553809363, - "rotation_rpy_deg_xyz": [ - -0.3785158442391572, - 0.6335173530627393, - 0.09325605860399434 - ], - "rotation_angle_deg": 0.7441128221767888, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -5.835267488141227e-05, - 0.02615561952146961, - 0.03479603674555261 - ], - "translation_xyz_cm": [ - -0.005835267488141227, - 2.615561952146961, - 3.479603674555261 - ], - "translation_norm_m": 0.04353026545731596, - "rotation_rpy_deg_xyz": [ - -0.7266335985293833, - -0.07727169162304574, - -0.7376425947964552 - ], - "rotation_angle_deg": 1.0386526423879934, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01433373545276373, - -0.04192830953837956, - -0.01556630273227179 - ], - "translation_xyz_cm": [ - 1.433373545276373, - -4.192830953837956, - -1.556630273227179 - ], - "translation_norm_m": 0.046965401025954395, - "rotation_rpy_deg_xyz": [ - 0.2573174046262459, - 0.1013226492809947, - -0.6422082803134666 - ], - "rotation_angle_deg": 0.699429350358039, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.006711463774185411, - -0.013035474629375043, - -0.007968978244607544 - ], - "translation_xyz_cm": [ - 0.6711463774185411, - -1.3035474629375043, - -0.7968978244607544 - ], - "translation_norm_m": 0.016687479110647954, - "rotation_rpy_deg_xyz": [ - -1.2639058382075403, - -1.006161602217825, - 0.1532780551103129 - ], - "rotation_angle_deg": 1.6216869757764145, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.005773227423529592, - 0.0017208279484272893, - 0.05812789768815708 - ], - "translation_xyz_cm": [ - 0.5773227423529592, - 0.17208279484272893, - 5.8127897688157075 - ], - "translation_norm_m": 0.05843923248432289, - "rotation_rpy_deg_xyz": [ - -0.16392432056566494, - -0.2890857930613764, - -0.1332664112772747 - ], - "rotation_angle_deg": 0.35820640723283, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00764248094436315, - -0.02961191284776543, - 0.013493456578567473 - ], - "translation_xyz_cm": [ - -0.764248094436315, - -2.961191284776543, - 1.3493456578567473 - ], - "translation_norm_m": 0.03342672984194378, - "rotation_rpy_deg_xyz": [ - 1.0986809047374615, - 0.06474960473127431, - -0.19818831549834356 - ], - "rotation_angle_deg": 1.1183986708695166, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011729696331109096, - 0.020233035848181924, - 0.03548287409515656 - ], - "translation_xyz_cm": [ - -1.1729696331109096, - 2.0233035848181924, - 3.5482874095156562 - ], - "translation_norm_m": 0.0424970101266734, - "rotation_rpy_deg_xyz": [ - 0.23178724983308435, - 1.1338889861351882, - -0.2790619883899568 - ], - "rotation_angle_deg": 1.1910419124051095, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008785451085047136, - -0.031575382693120324, - -0.05946253553295919 - ], - "translation_xyz_cm": [ - 0.08785451085047136, - -3.1575382693120324, - -5.946253553295919 - ], - "translation_norm_m": 0.06733178867171964, - "rotation_rpy_deg_xyz": [ - 0.6897102935200486, - 0.36245298825657307, - -0.07969197330181722 - ], - "rotation_angle_deg": 0.7834342911514396, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019494084105463605, - 0.0174206923525968, - -0.041718620390635695 - ], - "translation_xyz_cm": [ - -1.9494084105463605, - 1.74206923525968, - -4.171862039063569 - ], - "translation_norm_m": 0.04923355689418222, - "rotation_rpy_deg_xyz": [ - 0.1608902426319585, - 0.0774864007301993, - 0.07665293067706427 - ], - "rotation_angle_deg": 0.19429049612714216, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.032024548399142594, - 0.02153922873078018, - -0.07161429467303898 - ], - "translation_xyz_cm": [ - -3.2024548399142594, - 2.153922873078018, - -7.161429467303898 - ], - "translation_norm_m": 0.08135181175611735, - "rotation_rpy_deg_xyz": [ - 0.4357856033315988, - 0.7396617090725047, - 0.32589232997747175 - ], - "rotation_angle_deg": 0.9172656763444422, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009369146371038528, - 0.01276522110402889, - -0.0360189669818308 - ], - "translation_xyz_cm": [ - -0.9369146371038528, - 1.276522110402889, - -3.60189669818308 - ], - "translation_norm_m": 0.039345873430321844, - "rotation_rpy_deg_xyz": [ - 0.48153485495200554, - 0.6461951362403606, - 0.2494737503758602 - ], - "rotation_angle_deg": 0.8428064910261277, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.008601729267732727, - -0.0010688130452694011, - 0.055212285302563044 - ], - "translation_xyz_cm": [ - 0.8601729267732727, - -0.10688130452694011, - 5.5212285302563044 - ], - "translation_norm_m": 0.05588853689311187, - "rotation_rpy_deg_xyz": [ - 1.509414468898218, - -0.06063052683615484, - -0.26939977027597933 - ], - "rotation_angle_deg": 1.5343238302231954, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.009591881833361349, - 0.008576276121390114, - 0.0123248942831823 - ], - "translation_xyz_cm": [ - -0.9591881833361349, - 0.8576276121390114, - 1.23248942831823 - ], - "translation_norm_m": 0.017817399594416507, - "rotation_rpy_deg_xyz": [ - 1.438170545926305, - 0.40466716336577563, - 0.412388573587803 - ], - "rotation_angle_deg": 1.5485306931722174, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.009588245546250374, - 0.009401558653886033, - 0.010339461517525475 - ], - "translation_xyz_cm": [ - 0.9588245546250374, - 0.9401558653886033, - 1.0339461517525474 - ], - "translation_norm_m": 0.01694780877429409, - "rotation_rpy_deg_xyz": [ - 0.9597677235038649, - 1.0557128309952022, - -0.4906551349587616 - ], - "rotation_angle_deg": 1.5116429954571908, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005030742236358243, - 0.04080112546672965, - 0.0690844339531199 - ], - "translation_xyz_cm": [ - -0.5030742236358243, - 4.080112546672964, - 6.90844339531199 - ], - "translation_norm_m": 0.0803909150428298, - "rotation_rpy_deg_xyz": [ - -1.3277623379841577, - -0.49056287687666456, - 0.6090925040783209 - ], - "rotation_angle_deg": 1.5387152126776173, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02383315810861486, - 0.024668506538032986, - 0.049886782221625306 - ], - "translation_xyz_cm": [ - 2.383315810861486, - 2.4668506538032986, - 4.98867822216253 - ], - "translation_norm_m": 0.06054127253927754, - "rotation_rpy_deg_xyz": [ - -0.509553148412112, - -0.07169178239193863, - 0.49186875093964405 - ], - "rotation_angle_deg": 0.7116204915763964, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0035318898994751713, - 0.0006188922453423951, - 0.03202353765995061 - ], - "translation_xyz_cm": [ - -0.35318898994751713, - 0.061889224534239506, - 3.202353765995061 - ], - "translation_norm_m": 0.032223659601783826, - "rotation_rpy_deg_xyz": [ - 0.39183349651499577, - -1.2019617357018844, - 0.23521156248811265 - ], - "rotation_angle_deg": 1.2866606141461896, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.012789847460703552, - 0.007470468025288557, - 0.030385719771138922 - ], - "translation_xyz_cm": [ - -1.2789847460703552, - 0.7470468025288557, - 3.038571977113892 - ], - "translation_norm_m": 0.03380355094653676, - "rotation_rpy_deg_xyz": [ - -0.8208871439383635, - -1.0808237995614542, - 0.17361827053285486 - ], - "rotation_angle_deg": 1.3672853373204137, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009676105927339473, - 0.018131418999687954, - -0.048376313421369825 - ], - "translation_xyz_cm": [ - 0.9676105927339473, - 1.8131418999687954, - -4.837631342136983 - ], - "translation_norm_m": 0.052560851221245895, - "rotation_rpy_deg_xyz": [ - -0.29714640884567634, - -0.3339980552026732, - 0.09089356066947293 - ], - "rotation_angle_deg": 0.4560203866374267, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00438728986495085, - 0.004101758127807553, - -0.021876864738350463 - ], - "translation_xyz_cm": [ - -0.43872898649508496, - 0.4101758127807553, - -2.1876864738350466 - ], - "translation_norm_m": 0.02268633824305319, - "rotation_rpy_deg_xyz": [ - -0.042816125363480284, - -0.13499324042712507, - -0.050793745248947766 - ], - "rotation_angle_deg": 0.15047100026863872, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012317324836827792, - 0.022870572177132287, - -0.028055012236119052 - ], - "translation_xyz_cm": [ - 1.2317324836827792, - 2.2870572177132287, - -2.805501223611905 - ], - "translation_norm_m": 0.03823432063492357, - "rotation_rpy_deg_xyz": [ - 0.8521741430460135, - 0.379460933710213, - -0.1420726063514701 - ], - "rotation_angle_deg": 0.9440205119827517, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00401268287828116, - 0.0025759514787869753, - 0.020453226910591947 - ], - "translation_xyz_cm": [ - 0.40126828782811597, - 0.25759514787869753, - 2.045322691059195 - ], - "translation_norm_m": 0.021001705667847034, - "rotation_rpy_deg_xyz": [ - 1.1271435533022043, - -0.12217497954075623, - 0.020552888042921692 - ], - "rotation_angle_deg": 1.1339535438793684, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.03761588811823069, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.02564623883043149, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015144034812935, - -6.733076264476427e-05, - 0.7136929353101595 - ], - "rotation_rpy_deg_xyz": [ - -0.789527196617764, - 1.5026289218840854, - -0.8356133538033519 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07889765995849754, - "median": 0.052216799237171374, - "p90": 0.12159465082571498, - "p95": 0.1463744230803189, - "max": 0.23030226540327853 - }, - "rotation_deg": { - "rms": 1.0232658257505307, - "median": 0.8949974865044467, - "p90": 1.5848458757167272, - "p95": 1.657876976123964, - "max": 1.9535675159034995 - }, - "normalized_pair_score": { - "rms": 2.5842267894606974, - "median": 2.3032711151325724, - "p90": 3.5077587202194107, - "p95": 3.9938113112935043, - "max": 4.750197868386179 - }, - "normalized_global_rms": 2.5842267894606974 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.020511175434618445, - -0.016188653629575667, - 0.12626207153659968 - ], - "translation_xyz_cm": [ - 2.0511175434618445, - -1.6188653629575667, - 12.62620715365997 - ], - "translation_norm_m": 0.1289375489636804, - "rotation_rpy_deg_xyz": [ - -0.18671152704122398, - -0.1782500040559989, - -0.34302764623514037 - ], - "rotation_angle_deg": 0.4295360884271374, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.669238092496052, - "median": 0.7629681084794777, - "p90": 2.2411288080915024, - "p95": 3.711431307771875, - "max": 5.607648580302171 - }, - "height_residual_m": { - "rms": 0.034713965171217276, - "median": -0.0059241016060887774, - "p90": 0.05340926734199069, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.020511175434618445, - -0.016188653629575667, - 0.12626207153659968 - ], - "translation_xyz_cm": [ - 2.0511175434618445, - -1.6188653629575667, - 12.62620715365997 - ], - "translation_norm_m": 0.1289375489636804, - "rotation_rpy_deg_xyz": [ - -0.18671152704122398, - -0.1782500040559989, - -0.34302764623514037 - ], - "rotation_angle_deg": 0.4295360884271374, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03339802688621629, - 0.006700966210313908, - 0.10213129034860603 - ], - "translation_xyz_cm": [ - 3.339802688621629, - 0.6700966210313908, - 10.213129034860604 - ], - "translation_norm_m": 0.10766211783313323, - "rotation_rpy_deg_xyz": [ - -0.07981970935455779, - -0.21561777418196643, - -0.3969867659274467 - ], - "rotation_angle_deg": 0.4588896719700004, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03429606862575585, - -0.019101638851041713, - 0.044579215054795014 - ], - "translation_xyz_cm": [ - 3.429606862575585, - -1.9101638851041713, - 4.457921505479502 - ], - "translation_norm_m": 0.059400331184934006, - "rotation_rpy_deg_xyz": [ - 0.32091072252069974, - 0.08734142047373276, - -0.3497332866951523 - ], - "rotation_angle_deg": 0.4828004885149152, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.046147203902671574, - 0.010701062186338262, - 0.0219662687460669 - ], - "translation_xyz_cm": [ - 4.614720390267157, - 1.0701062186338262, - 2.19662687460669 - ], - "translation_norm_m": 0.052216799237171374, - "rotation_rpy_deg_xyz": [ - 0.5027148994751668, - 0.2851160037371347, - -0.3804228385266284 - ], - "rotation_angle_deg": 0.6925928567772764, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.005325411439341403, - 0.020326322409281783, - -0.00986288737377779 - ], - "translation_xyz_cm": [ - 0.5325411439341403, - 2.0326322409281783, - -0.9862887373777791 - ], - "translation_norm_m": 0.02321197830931617, - "rotation_rpy_deg_xyz": [ - 0.33231974455663577, - 0.21718146043454795, - -0.03247223815714744 - ], - "rotation_angle_deg": 0.3983709495374952, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.032353316357629336, - -0.0012175181325369544, - -0.07162922315152437 - ], - "translation_xyz_cm": [ - -3.2353316357629334, - -0.12175181325369544, - -7.162922315152437 - ], - "translation_norm_m": 0.07860639311805864, - "rotation_rpy_deg_xyz": [ - 0.7326654634690407, - 0.5415789153781889, - 0.5382321661196461 - ], - "rotation_angle_deg": 1.0564386842724607, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03126149726922191, - -0.021163474659060433, - -0.0513307939314741 - ], - "translation_xyz_cm": [ - -3.1261497269221907, - -2.1163474659060433, - -5.13307939314741 - ], - "translation_norm_m": 0.06371831978947437, - "rotation_rpy_deg_xyz": [ - 0.5921070942240404, - 0.35912463226373714, - 0.5882300473956759 - ], - "rotation_angle_deg": 0.9074069975875975, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03776491485383672, - -0.03934091377689963, - -0.07746995431007916 - ], - "translation_xyz_cm": [ - -3.776491485383672, - -3.9340913776899633, - -7.7469954310079165 - ], - "translation_norm_m": 0.09473906328186248, - "rotation_rpy_deg_xyz": [ - 0.8069781317644149, - 0.81488511546382, - 0.5056242024651121 - ], - "rotation_angle_deg": 1.251033426269492, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013238404667166435, - -0.011033982141765653, - -0.030319561192041548 - ], - "translation_xyz_cm": [ - -1.3238404667166435, - -1.1033982141765653, - -3.0319561192041546 - ], - "translation_norm_m": 0.03487520481537577, - "rotation_rpy_deg_xyz": [ - 0.39890906157208783, - 0.27502989396684585, - -0.08595883719900999 - ], - "rotation_angle_deg": 0.492263192822224, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008695504379009344, - 0.015042653886250812, - -0.13908918738904175 - ], - "translation_xyz_cm": [ - 0.8695504379009344, - 1.5042653886250812, - -13.908918738904175 - ], - "translation_norm_m": 0.1401702367868831, - "rotation_rpy_deg_xyz": [ - -0.7170556581039831, - 0.6854064320564691, - 0.29332212359925375 - ], - "rotation_angle_deg": 1.0356140470582071, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0013959861725622025, - -0.0035694751170609607, - 0.00333345610348847 - ], - "translation_xyz_cm": [ - 0.13959861725622025, - -0.35694751170609607, - 0.33334561034884697 - ], - "translation_norm_m": 0.005079553090497899, - "rotation_rpy_deg_xyz": [ - 0.3197558885989856, - -0.2724133896493295, - -0.4748712093121267 - ], - "rotation_angle_deg": 0.6334290863223099, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010458979538632007, - 0.02003810229943148, - -0.06307301853370757 - ], - "translation_xyz_cm": [ - 1.0458979538632007, - 2.003810229943148, - -6.307301853370757 - ], - "translation_norm_m": 0.06700090643943128, - "rotation_rpy_deg_xyz": [ - 0.12042227428314684, - 0.013553812623009016, - 0.007430293854184903 - ], - "rotation_angle_deg": 0.12140933857173933, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012952732171880865, - 0.03927041581326507, - -0.11239333431108585 - ], - "translation_xyz_cm": [ - 1.2952732171880865, - 3.927041581326507, - -11.239333431108586 - ], - "translation_norm_m": 0.11975892629122359, - "rotation_rpy_deg_xyz": [ - -0.8072212425753459, - -0.1833953780362801, - 0.1699205588735543 - ], - "rotation_angle_deg": 0.8447916291782677, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006859284238813879, - 0.016110286104011773, - -0.05351421621752127 - ], - "translation_xyz_cm": [ - 0.6859284238813879, - 1.6110286104011773, - -5.351421621752126 - ], - "translation_norm_m": 0.056305971583816686, - "rotation_rpy_deg_xyz": [ - -0.8689165051986111, - -0.07608122910608621, - 0.16688600631834588 - ], - "rotation_angle_deg": 0.8879538178155421, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0005729810919530287, - 0.005787994463778645, - 0.009513486556872877 - ], - "translation_xyz_cm": [ - 0.05729810919530287, - 0.5787994463778645, - 0.9513486556872878 - ], - "translation_norm_m": 0.011150588043339637, - "rotation_rpy_deg_xyz": [ - 0.222764843315744, - 1.8798476224582814, - 0.4863697507286901 - ], - "rotation_angle_deg": 1.9535675159034995, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.036842128761104154, - -0.010773321385600498, - 0.22708088106345486 - ], - "translation_xyz_cm": [ - 3.6842128761104154, - -1.0773321385600498, - 22.708088106345485 - ], - "translation_norm_m": 0.23030226540327853, - "rotation_rpy_deg_xyz": [ - 0.4358253749247479, - -0.10604806775315798, - -0.2383653677960376 - ], - "rotation_angle_deg": 0.5077552299258097, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011031272107893564, - 0.02253260535326662, - 0.20064975954470615 - ], - "translation_xyz_cm": [ - -1.1031272107893564, - 2.253260535326662, - 20.064975954470615 - ], - "translation_norm_m": 0.20221209972124032, - "rotation_rpy_deg_xyz": [ - 0.9904786141162382, - -0.3172842352995258, - -0.688619638376147 - ], - "rotation_angle_deg": 1.2458417314562336, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0013092051394535398, - -0.005891243048300243, - -0.05308619316409124 - ], - "translation_xyz_cm": [ - 0.13092051394535398, - -0.5891243048300243, - -5.308619316409124 - ], - "translation_norm_m": 0.053428126182812403, - "rotation_rpy_deg_xyz": [ - -0.30823470881648185, - 0.6638249841602342, - 0.09527351844061997 - ], - "rotation_angle_deg": 0.7383009832708094, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.000305829450234274, - 0.02545474290972005, - 0.028605399411666205 - ], - "translation_xyz_cm": [ - 0.0305829450234274, - 2.545474290972005, - 2.8605399411666204 - ], - "translation_norm_m": 0.03829237970867738, - "rotation_rpy_deg_xyz": [ - -0.670927352394488, - -0.059320945162793126, - -0.7362017090479659 - ], - "rotation_angle_deg": 0.9980784326541213, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014802227733057727, - -0.04288152802817491, - -0.014874697230913477 - ], - "translation_xyz_cm": [ - 1.4802227733057727, - -4.288152802817491, - -1.4874697230913476 - ], - "translation_norm_m": 0.04774084215432106, - "rotation_rpy_deg_xyz": [ - 0.33433965918758896, - 0.13931830163164804, - -0.6395355289771951 - ], - "rotation_angle_deg": 0.7353344779155774, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.006639523013829418, - -0.01364226927104989, - -0.0015778634706750672 - ], - "translation_xyz_cm": [ - 0.6639523013829418, - -1.364226927104989, - -0.15778634706750672 - ], - "translation_norm_m": 0.015253997176054981, - "rotation_rpy_deg_xyz": [ - -1.2112557753694466, - -0.9902346417424631, - 0.15448919686066662 - ], - "rotation_angle_deg": 1.571082441547839, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006662878474425149, - 0.00039441457198924335, - 0.05892478846949487 - ], - "translation_xyz_cm": [ - 0.6662878474425149, - 0.039441457198924335, - 5.892478846949487 - ], - "translation_norm_m": 0.05930160376072701, - "rotation_rpy_deg_xyz": [ - -0.06837607401948174, - -0.21323295921751284, - -0.12995232038699242 - ], - "rotation_angle_deg": 0.2589676234364985, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.004987123739785382, - -0.02974152315837536, - 0.008299599250221626 - ], - "translation_xyz_cm": [ - -0.4987123739785382, - -2.974152315837536, - 0.8299599250221625 - ], - "translation_norm_m": 0.031277994671819805, - "rotation_rpy_deg_xyz": [ - 1.1206230898171896, - 0.2618390097009116, - -0.1910992823496523 - ], - "rotation_angle_deg": 1.166983271299156, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011446678898185958, - 0.019387338305032475, - 0.030338428179015223 - ], - "translation_xyz_cm": [ - -1.1446678898185958, - 1.9387338305032475, - 3.0338428179015224 - ], - "translation_norm_m": 0.03777983018391189, - "rotation_rpy_deg_xyz": [ - 0.2999495386373908, - 1.162035190141584, - -0.27681572340514565 - ], - "rotation_angle_deg": 1.2323151150773601, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021834551166075578, - -0.032712282688967975, - -0.061290727853742386 - ], - "translation_xyz_cm": [ - 0.21834551166075578, - -3.2712282688967975, - -6.129072785374238 - ], - "translation_norm_m": 0.06950837529255526, - "rotation_rpy_deg_xyz": [ - 0.7882339272882655, - 0.46453417179279993, - -0.07447087597231694 - ], - "rotation_angle_deg": 0.918217312987476, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.018747804187171146, - 0.016326715184082796, - -0.039009104527387775 - ], - "translation_xyz_cm": [ - -1.8747804187171146, - 1.6326715184082796, - -3.9009104527387777 - ], - "translation_norm_m": 0.04625745374068202, - "rotation_rpy_deg_xyz": [ - 0.25187845244707896, - 0.1393551662803256, - 0.08003518245965324 - ], - "rotation_angle_deg": 0.29869578449052353, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.030611550498516382, - 0.020423399610432713, - -0.07052300828674504 - ], - "translation_xyz_cm": [ - -3.061155049851638, - 2.0423399610432713, - -7.052300828674504 - ], - "translation_norm_m": 0.07954669681000558, - "rotation_rpy_deg_xyz": [ - 0.533199824973564, - 0.8547951137973345, - 0.33092099040580664 - ], - "rotation_angle_deg": 1.059171816094831, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009138566287286931, - 0.012168155673566217, - -0.03746446219473293 - ], - "translation_xyz_cm": [ - -0.9138566287286931, - 1.2168155673566217, - -3.7464462194732926 - ], - "translation_norm_m": 0.040437152889686134, - "rotation_rpy_deg_xyz": [ - 0.5330293693876373, - 0.6613204709461823, - 0.2511217543985133 - ], - "rotation_angle_deg": 0.8848603919932242, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.010408054022772006, - -0.0023387044342224605, - 0.060238400784749235 - ], - "translation_xyz_cm": [ - 1.0408054022772006, - -0.23387044342224605, - 6.023840078474923 - ], - "translation_norm_m": 0.06117566555482392, - "rotation_rpy_deg_xyz": [ - 1.5920059573974432, - 0.09328888270996957, - -0.2610153253741009 - ], - "rotation_angle_deg": 1.616164101807619, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007250632219955477, - 0.008057140584174283, - 0.009017525390051587 - ], - "translation_xyz_cm": [ - -0.7250632219955477, - 0.8057140584174283, - 0.9017525390051586 - ], - "translation_norm_m": 0.014099820784053597, - "rotation_rpy_deg_xyz": [ - 1.4918584304124831, - 0.587918836533132, - 0.42096170349774287 - ], - "rotation_angle_deg": 1.655905690513936, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011904564038967447, - 0.008702333523734396, - 0.0085567429872931 - ], - "translation_xyz_cm": [ - 1.1904564038967447, - 0.8702333523734396, - 0.85567429872931 - ], - "translation_norm_m": 0.017048961970359898, - "rotation_rpy_deg_xyz": [ - 1.0160464473471853, - 1.2373059199385135, - -0.48359657928779864 - ], - "rotation_angle_deg": 1.6756185466142162, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005161863206924799, - 0.04150549086370525, - 0.07562741304762562 - ], - "translation_xyz_cm": [ - -0.5161863206924799, - 4.150549086370525, - 7.562741304762562 - ], - "translation_norm_m": 0.08642254455800465, - "rotation_rpy_deg_xyz": [ - -1.3768440808907498, - -0.47850339884573495, - 0.6077288452158585 - ], - "rotation_angle_deg": 1.577016319194004, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024512403438020414, - 0.025911894691640125, - 0.05694664593761874 - ], - "translation_xyz_cm": [ - 2.4512403438020414, - 2.5911894691640125, - 5.694664593761874 - ], - "translation_norm_m": 0.06719527284239146, - "rotation_rpy_deg_xyz": [ - -0.6067566062264121, - -0.0004442326279066463, - 0.48969055174729736 - ], - "rotation_angle_deg": 0.7797089638392719, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003393704163737965, - 0.001349888079171413, - 0.034638250715639904 - ], - "translation_xyz_cm": [ - -0.3393704163737965, - 0.1349888079171413, - 3.46382507156399 - ], - "translation_norm_m": 0.03483027186825836, - "rotation_rpy_deg_xyz": [ - 0.32915537252877486, - -1.1809807014663454, - 0.23404185184291187 - ], - "rotation_angle_deg": 1.2487658739696963, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.011623080890649007, - 0.008715155213274095, - 0.0311152763780687 - ], - "translation_xyz_cm": [ - -1.1623080890649007, - 0.8715155213274095, - 3.1115276378068697 - ], - "translation_norm_m": 0.034339632552862716, - "rotation_rpy_deg_xyz": [ - -0.9221921033299263, - -0.984632153950116, - 0.170908717973468 - ], - "rotation_angle_deg": 1.3588295381249569, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011454400156202915, - 0.01918145316678499, - -0.04684585614356356 - ], - "translation_xyz_cm": [ - 1.1454400156202915, - 1.918145316678499, - -4.684585614356356 - ], - "translation_norm_m": 0.05190053628192525, - "rotation_rpy_deg_xyz": [ - -0.38602506869271896, - -0.18549993781062057, - 0.08979861006881007 - ], - "rotation_angle_deg": 0.43746654037161986, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0039283035552926115, - 0.005049315186078207, - -0.02220299955166502 - ], - "translation_xyz_cm": [ - -0.39283035552926115, - 0.5049315186078207, - -2.220299955166502 - ], - "translation_norm_m": 0.02310628359910182, - "rotation_rpy_deg_xyz": [ - -0.11995665714557782, - -0.10031212568290666, - -0.05232194167956691 - ], - "rotation_angle_deg": 0.16492631953056403, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.013421259529148521, - 0.02413806371300886, - -0.030880233787270346 - ], - "translation_xyz_cm": [ - 1.3421259529148521, - 2.413806371300886, - -3.088023378727035 - ], - "translation_norm_m": 0.041429037714126406, - "rotation_rpy_deg_xyz": [ - 0.7521486653054597, - 0.46280006020498643, - -0.14229535057390852 - ], - "rotation_angle_deg": 0.8949974865044467, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004166129782936734, - 0.003198668461998233, - 0.018190717024790904 - ], - "translation_xyz_cm": [ - 0.4166129782936734, - 0.3198668461998233, - 1.8190717024790903 - ], - "translation_norm_m": 0.018933840159198353, - "rotation_rpy_deg_xyz": [ - 1.0840789796824881, - -0.11308099506713808, - 0.01976097721021556 - ], - "rotation_angle_deg": 1.090159130001415, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0850854537837531, - "improved_pairs": 16, - "worsened_pairs": 23, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.054065192130319684, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0024476764333135033, - 0.7204936800355414 - ], - "rotation_rpy_deg_xyz": [ - -0.9851737312819089, - 1.1997371245619126, - -0.8397031987625543 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08136434456273667, - "median": 0.0547999406436842, - "p90": 0.1208364381197521, - "p95": 0.14315144233353094, - "max": 0.2369024204480351 - }, - "rotation_deg": { - "rms": 0.9671396098919116, - "median": 0.8988046712765143, - "p90": 1.4794204316893373, - "p95": 1.6889751813598624, - "max": 1.8256686622280407 - }, - "normalized_pair_score": { - "rms": 2.5277457796497282, - "median": 2.167376735579477, - "p90": 3.4996884812336346, - "p95": 3.78758722605327, - "max": 4.929538933736601 - }, - "normalized_global_rms": 2.5277457796497282 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021884758090912948, - -0.014401607085913204, - 0.13136342147234598 - ], - "translation_xyz_cm": [ - 2.188475809091295, - -1.4401607085913204, - 13.136342147234597 - ], - "translation_norm_m": 0.1339503543268028, - "rotation_rpy_deg_xyz": [ - -0.3411487315866048, - -0.12290144584962129, - -0.3460685068801038 - ], - "rotation_angle_deg": 0.501501180601739, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7107124278398285, - "median": 0.7334463903250042, - "p90": 2.3653698912452787, - "p95": 4.0266291870908315, - "max": 5.724141872865437 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021884758090912948, - -0.014401607085913204, - 0.13136342147234598 - ], - "translation_xyz_cm": [ - 2.188475809091295, - -1.4401607085913204, - 13.136342147234597 - ], - "translation_norm_m": 0.1339503543268028, - "rotation_rpy_deg_xyz": [ - -0.3411487315866048, - -0.12290144584962129, - -0.3460685068801038 - ], - "rotation_angle_deg": 0.501501180601739, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03476968230027355, - 0.009911850173705883, - 0.10748792968374292 - ], - "translation_xyz_cm": [ - 3.4769682300273552, - 0.9911850173705883, - 10.748792968374293 - ], - "translation_norm_m": 0.11340560219330088, - "rotation_rpy_deg_xyz": [ - -0.33103742238834116, - -0.16221857588085575, - -0.40227751130058514 - ], - "rotation_angle_deg": 0.5459892308924431, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034989288786325345, - -0.01834221554805099, - 0.04750500446603653 - ], - "translation_xyz_cm": [ - 3.4989288786325345, - -1.8342215548050989, - 4.750500446603653 - ], - "translation_norm_m": 0.06178521384847824, - "rotation_rpy_deg_xyz": [ - 0.24714139852928368, - 0.12383493666369755, - -0.35072741062734897 - ], - "rotation_angle_deg": 0.44677819871751584, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04715810104964524, - 0.0127184893171165, - 0.02484727408455813 - ], - "translation_xyz_cm": [ - 4.715810104964524, - 1.27184893171165, - 2.484727408455813 - ], - "translation_norm_m": 0.0547999406436842, - "rotation_rpy_deg_xyz": [ - 0.33424751739044706, - 0.34183533894451984, - -0.3831042791961537 - ], - "rotation_angle_deg": 0.6132735794423378, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00587532542847782, - 0.021423066916313543, - -0.010215949718934657 - ], - "translation_xyz_cm": [ - 0.587532542847782, - 2.1423066916313545, - -1.0215949718934656 - ], - "translation_norm_m": 0.02445062113017105, - "rotation_rpy_deg_xyz": [ - 0.2446713128621526, - 0.2583466530988345, - -0.033694996720690165 - ], - "rotation_angle_deg": 0.3574625369550116, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031978442893913835, - 0.0020952833851497488, - -0.07090716107262503 - ], - "translation_xyz_cm": [ - -3.1978442893913837, - 0.20952833851497488, - -7.0907161072625025 - ], - "translation_norm_m": 0.0778128300074132, - "rotation_rpy_deg_xyz": [ - 0.4635470008843789, - 0.5918076958326788, - 0.53318580640598 - ], - "rotation_angle_deg": 0.9202393204535686, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030828101413242825, - -0.01899897628782729, - -0.05055372428651778 - ], - "translation_xyz_cm": [ - -3.0828101413242823, - -1.8998976287827292, - -5.055372428651778 - ], - "translation_norm_m": 0.06218530353683148, - "rotation_rpy_deg_xyz": [ - 0.4195884533171335, - 0.4161324209897413, - 0.5855464907316213 - ], - "rotation_angle_deg": 0.8308412211602583, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.037549183715323814, - -0.035851952746542404, - -0.07657494530905 - ], - "translation_xyz_cm": [ - -3.7549183715323813, - -3.5851952746542404, - -7.657494530905 - ], - "translation_norm_m": 0.09251500398590191, - "rotation_rpy_deg_xyz": [ - 0.5200185744125289, - 0.8609458529605756, - 0.5001015846243679 - ], - "rotation_angle_deg": 1.1215299291061964, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012730290269494023, - -0.00968152838721223, - -0.030932971931169492 - ], - "translation_xyz_cm": [ - -1.2730290269494022, - -0.9681528387212229, - -3.0932971931169493 - ], - "translation_norm_m": 0.034822995775097954, - "rotation_rpy_deg_xyz": [ - 0.2936680043662151, - 0.3212370253283076, - -0.08744652315413347 - ], - "rotation_angle_deg": 0.44409991550278916, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008455517119271283, - 0.01693976089265392, - -0.1313167666506156 - ], - "translation_xyz_cm": [ - 0.8455517119271283, - 1.6939760892653921, - -13.131676665061558 - ], - "translation_norm_m": 0.13267458110891778, - "rotation_rpy_deg_xyz": [ - -0.8589352425955696, - 0.7390515558348104, - 0.29006933878870467 - ], - "rotation_angle_deg": 1.1710285946725474, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.002206761277007918, - -0.0003230168700503744, - -0.0008326113697621623 - ], - "translation_xyz_cm": [ - 0.2206761277007918, - -0.03230168700503744, - -0.08326113697621623 - ], - "translation_norm_m": 0.0023806253222831983, - "rotation_rpy_deg_xyz": [ - 0.06595145035821497, - -0.21939243755063725, - -0.47985956969274 - ], - "rotation_angle_deg": 0.5316261357000228, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010498512271429783, - 0.021105741161081215, - -0.062073216285429625 - ], - "translation_xyz_cm": [ - 1.0498512271429783, - 2.1105741161081215, - -6.207321628542963 - ], - "translation_norm_m": 0.06639845818909988, - "rotation_rpy_deg_xyz": [ - 0.04535756883865925, - 0.05050677400062785, - 0.006285325021587809 - ], - "rotation_angle_deg": 0.06817255413092452, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012803844285578792, - 0.04150144791112176, - -0.10958401117735066 - ], - "translation_xyz_cm": [ - 1.2803844285578792, - 4.150144791112176, - -10.958401117735066 - ], - "translation_norm_m": 0.11787690237246064, - "rotation_rpy_deg_xyz": [ - -0.9812013910240344, - -0.12637778099477365, - 0.16580979262889156 - ], - "rotation_angle_deg": 1.0029259565636819, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007024816096084352, - 0.017364227581084246, - -0.052790548078376395 - ], - "translation_xyz_cm": [ - 0.7024816096084352, - 1.7364227581084246, - -5.27905480783764 - ], - "translation_norm_m": 0.05601523370554534, - "rotation_rpy_deg_xyz": [ - -0.9605481423764163, - -0.03372400271012844, - 0.16470440258387845 - ], - "rotation_angle_deg": 0.9751019434315028, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0010907088369185303, - 0.012439554331656, - 0.01569560254970474 - ], - "translation_xyz_cm": [ - -0.10907088369185303, - 1.2439554331656, - 1.569560254970474 - ], - "translation_norm_m": 0.02005702114311723, - "rotation_rpy_deg_xyz": [ - -0.2961542013792496, - 1.7373384628845212, - 0.4720162782717484 - ], - "rotation_angle_deg": 1.8256686622280407, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.034210551568836234, - -0.0025434504069030694, - 0.2344054731347398 - ], - "translation_xyz_cm": [ - 3.4210551568836234, - -0.25434504069030694, - 23.44054731347398 - ], - "translation_norm_m": 0.2369024204480351, - "rotation_rpy_deg_xyz": [ - -0.11134892780675792, - -0.3296865791435226, - -0.25537257238229577 - ], - "rotation_angle_deg": 0.43182214069998553, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009801906762904267, - 0.027220818930151047, - 0.22410138127526333 - ], - "translation_xyz_cm": [ - -0.9801906762904267, - 2.7220818930151047, - 22.410138127526334 - ], - "translation_norm_m": 0.22596123439408292, - "rotation_rpy_deg_xyz": [ - 0.6297513245059657, - -0.29949022299709843, - -0.6966056360314147 - ], - "rotation_angle_deg": 0.9845001675553328, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0017067558207800038, - -0.0025635273686299698, - -0.04627768032865373 - ], - "translation_xyz_cm": [ - 0.17067558207800038, - -0.256352736862997, - -4.627768032865373 - ], - "translation_norm_m": 0.046380042956023076, - "rotation_rpy_deg_xyz": [ - -0.5797201231143607, - 0.7134573071811255, - 0.089255162120271 - ], - "rotation_angle_deg": 0.9239605154272846, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006491512351978201, - 0.027984727154258815, - 0.04796715829717854 - ], - "translation_xyz_cm": [ - 0.06491512351978201, - 2.7984727154258815, - 4.796715829717854 - ], - "translation_norm_m": 0.05553750648283603, - "rotation_rpy_deg_xyz": [ - -0.8739536008449633, - -0.0017265021665758822, - -0.7408750397469878 - ], - "rotation_angle_deg": 1.145732329167195, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015479254399599185, - -0.038875101141406354, - -0.026907080797172814 - ], - "translation_xyz_cm": [ - 1.5479254399599185, - -3.8875101141406354, - -2.6907080797172815 - ], - "translation_norm_m": 0.04974808340577223, - "rotation_rpy_deg_xyz": [ - 0.027203249509821417, - 0.17939932428271854, - -0.6460335130032695 - ], - "rotation_angle_deg": 0.6710723594408088, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.008383774783964348, - -0.011481034137462376, - -0.026899124591413887 - ], - "translation_xyz_cm": [ - 0.8383774783964348, - -1.1481034137462376, - -2.6899124591413885 - ], - "translation_norm_m": 0.030424738754477747, - "rotation_rpy_deg_xyz": [ - -1.4010206685584425, - -0.932651022498358, - 0.14958957343314738 - ], - "rotation_angle_deg": 1.6886732829341777, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006765024920033946, - 0.0062594799762789866, - 0.0518512750837777 - ], - "translation_xyz_cm": [ - 0.6765024920033946, - 0.6259479976278987, - 5.185127508377771 - ], - "translation_norm_m": 0.05266404256754037, - "rotation_rpy_deg_xyz": [ - -0.5067619523444589, - -0.2496112080194829, - -0.14067500895733773 - ], - "rotation_angle_deg": 0.582419861657302, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01228483265921021, - -0.02410472025382232, - 0.019838107310334988 - ], - "translation_xyz_cm": [ - -1.228483265921021, - -2.410472025382232, - 1.9838107310334987 - ], - "translation_norm_m": 0.03354854920315029, - "rotation_rpy_deg_xyz": [ - 0.6605557338745041, - -0.2853661621079659, - -0.21894181722667275 - ], - "rotation_angle_deg": 0.751652448737909, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010381008299317873, - 0.022545229310150017, - 0.04107819016614633 - ], - "translation_xyz_cm": [ - -1.0381008299317873, - 2.2545229310150017, - 4.107819016614633 - ], - "translation_norm_m": 0.04799448307132639, - "rotation_rpy_deg_xyz": [ - 0.039130002020063115, - 1.2138599492193627, - -0.28201120565151955 - ], - "rotation_angle_deg": 1.246895427205954, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008365007658843737, - -0.02646163009271585, - -0.0672252669008099 - ], - "translation_xyz_cm": [ - 0.08365007658843737, - -2.646163009271585, - -6.722526690080991 - ], - "translation_norm_m": 0.0722506339804723, - "rotation_rpy_deg_xyz": [ - 0.2883530701373031, - 0.3553265212262298, - -0.08898099231574966 - ], - "rotation_angle_deg": 0.4663484308021419, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.018802976405497773, - 0.021297077310893586, - -0.05130521615992469 - ], - "translation_xyz_cm": [ - -1.8802976405497773, - 2.1297077310893586, - -5.130521615992469 - ], - "translation_norm_m": 0.058645908884665456, - "rotation_rpy_deg_xyz": [ - -0.14490220819361774, - 0.1357623103923054, - 0.07061657725235224 - ], - "rotation_angle_deg": 0.21080556664220482, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03263600186863436, - 0.026693993916131142, - -0.07622428955633086 - ], - "translation_xyz_cm": [ - -3.2636001868634357, - 2.6693993916131142, - -7.622428955633086 - ], - "translation_norm_m": 0.08710809518943301, - "rotation_rpy_deg_xyz": [ - 0.010582282226487728, - 0.7041578648041859, - 0.3155468405565625 - ], - "rotation_angle_deg": 0.7716720796274404, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008535328780574392, - 0.014443141564858819, - -0.03537609465982737 - ], - "translation_xyz_cm": [ - -0.8535328780574392, - 1.444314156485882, - -3.537609465982737 - ], - "translation_norm_m": 0.03915257653125935, - "rotation_rpy_deg_xyz": [ - 0.34824841459641154, - 0.7189071662439137, - 0.24809777480623468 - ], - "rotation_angle_deg": 0.8358051851448747, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007123883710499657, - 0.0053440557194659455, - 0.045578909976909665 - ], - "translation_xyz_cm": [ - 0.7123883710499657, - 0.5344055719465945, - 4.557890997690967 - ], - "translation_norm_m": 0.046440776106097904, - "rotation_rpy_deg_xyz": [ - 1.0360812278738656, - -0.20317589668802832, - -0.28553434760711205 - ], - "rotation_angle_deg": 1.093262147919508, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01280759761649719, - 0.014598842277689483, - 0.008966860768096177 - ], - "translation_xyz_cm": [ - -1.280759761649719, - 1.4598842277689483, - 0.8966860768096176 - ], - "translation_norm_m": 0.02139077709176038, - "rotation_rpy_deg_xyz": [ - 0.964049152287267, - 0.1455829965047165, - 0.3921696368483664 - ], - "rotation_angle_deg": 1.0504367418527434, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0065319607452565265, - 0.015743286195249118, - 0.0035094992870426805 - ], - "translation_xyz_cm": [ - 0.6531960745256526, - 1.5743286195249118, - 0.35094992870426805 - ], - "translation_norm_m": 0.017402130807715667, - "rotation_rpy_deg_xyz": [ - 0.48384929762611883, - 0.8049604680038971, - -0.5085061776875379 - ], - "rotation_angle_deg": 1.069624729901989, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00642013471774483, - 0.0396487459315924, - 0.06651887220962917 - ], - "translation_xyz_cm": [ - -0.642013471774483, - 3.96487459315924, - 6.651887220962917 - ], - "translation_norm_m": 0.07770457865391803, - "rotation_rpy_deg_xyz": [ - -1.2537279219394992, - -0.6129076551931512, - 0.6116377738454287 - ], - "rotation_angle_deg": 1.5209713443977422, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.019432872008785296, - 0.023788408978217657, - 0.05307540151333297 - ], - "translation_xyz_cm": [ - 1.9432872008785296, - 2.3788408978217657, - 5.3075401513332965 - ], - "translation_norm_m": 0.06132310463460151, - "rotation_rpy_deg_xyz": [ - -0.4575528269524971, - -0.4086377636786511, - 0.4906793560271351 - ], - "rotation_angle_deg": 0.7845388581324091, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005644661489842218, - -0.0004575503985776441, - 0.0323325844901744 - ], - "translation_xyz_cm": [ - -0.5644661489842218, - -0.04575503985776441, - 3.23325844901744 - ], - "translation_norm_m": 0.032824801225847695, - "rotation_rpy_deg_xyz": [ - 0.4754006888735035, - -1.3693094476530787, - 0.2332519109305661 - ], - "rotation_angle_deg": 1.469032703512236, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.018055864453315085, - 0.007357305848301243, - 0.03805759736340708 - ], - "translation_xyz_cm": [ - -1.8055864453315085, - 0.7357305848301243, - 3.805759736340708 - ], - "translation_norm_m": 0.0427612547474597, - "rotation_rpy_deg_xyz": [ - -0.8104871463006269, - -1.475986456177483, - 0.17336505308787728 - ], - "rotation_angle_deg": 1.6916922671910237, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0039928586759065965, - 0.01971220067077417, - -0.052307657958153626 - ], - "translation_xyz_cm": [ - 0.39928586759065965, - 1.9712200670774171, - -5.230765795815363 - ], - "translation_norm_m": 0.05604109971046094, - "rotation_rpy_deg_xyz": [ - -0.41617305849848346, - -0.8087510438140599, - 0.08379653518431802 - ], - "rotation_angle_deg": 0.9131291497846249, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.007345260352235039, - 0.003014863969969639, - -0.016030954449801786 - ], - "translation_xyz_cm": [ - -0.7345260352235039, - 0.3014863969969639, - -1.6030954449801786 - ], - "translation_norm_m": 0.01788948727524511, - "rotation_rpy_deg_xyz": [ - 0.042194771309552036, - -0.3586488338075367, - -0.05232277315442333 - ], - "rotation_angle_deg": 0.36487425616113806, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007774507576636003, - 0.022547222647278264, - -0.026018343121312203 - ], - "translation_xyz_cm": [ - 0.7774507576636003, - 2.2547222647278264, - -2.60183431213122 - ], - "translation_norm_m": 0.03529552940449318, - "rotation_rpy_deg_xyz": [ - 0.8856541371412744, - 0.012897979988288805, - -0.15254599964197754 - ], - "rotation_angle_deg": 0.8988046712765143, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0025843191916425923, - 0.0014625542423660765, - 0.026114262209797425 - ], - "translation_xyz_cm": [ - 0.2584319191642592, - 0.14625542423660765, - 2.6114262209797423 - ], - "translation_norm_m": 0.02628255051090379, - "rotation_rpy_deg_xyz": [ - 1.19517089849679, - -0.2264465782480122, - 0.01837057344178999 - ], - "rotation_angle_deg": 1.2166075417205533, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.028604443972783944, - "improved_pairs": 12, - "worsened_pairs": 27, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.05528357443912335, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0011901746480735614, - 0.7204968546603007 - ], - "rotation_rpy_deg_xyz": [ - -0.8851624923523462, - 1.2012008027315206, - -0.837607902463532 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08054864611850543, - "median": 0.05456907800126671, - "p90": 0.1194804691776994, - "p95": 0.14367726961177968, - "max": 0.23494876573359258 - }, - "rotation_deg": { - "rms": 0.958376027630505, - "median": 0.8509173541406347, - "p90": 1.4330395260916942, - "p95": 1.5728348191197603, - "max": 1.7170587993517705 - }, - "normalized_pair_score": { - "rms": 2.503831503507573, - "median": 2.2336571035275097, - "p90": 3.456256236818977, - "p95": 3.619888634491064, - "max": 4.960231383846751 - }, - "normalized_global_rms": 2.503831503507573 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021206993608963498, - -0.014344119831277258, - 0.13220502886113733 - ], - "translation_xyz_cm": [ - 2.12069936089635, - -1.4344119831277258, - 13.220502886113733 - ], - "translation_norm_m": 0.13466127879921094, - "rotation_rpy_deg_xyz": [ - -0.3301467913749382, - -0.16706207538237808, - -0.3463000555288329 - ], - "rotation_angle_deg": 0.5071126466746416, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.685676496509504, - "median": 0.7553149459813134, - "p90": 2.3646467024572515, - "p95": 3.99536236407491, - "max": 5.626801242035707 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021206993608963498, - -0.014344119831277258, - 0.13220502886113733 - ], - "translation_xyz_cm": [ - 2.12069936089635, - -1.4344119831277258, - 13.220502886113733 - ], - "translation_norm_m": 0.13466127879921094, - "rotation_rpy_deg_xyz": [ - -0.3301467913749382, - -0.16706207538237808, - -0.3463000555288329 - ], - "rotation_angle_deg": 0.5071126466746416, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03375120903065354, - 0.009747130464839548, - 0.10859263309211162 - ], - "translation_xyz_cm": [ - 3.375120903065354, - 0.9747130464839548, - 10.859263309211162 - ], - "translation_norm_m": 0.11413374008244648, - "rotation_rpy_deg_xyz": [ - -0.30468670572341167, - -0.22841890329282416, - -0.4024385784033479 - ], - "rotation_angle_deg": 0.5544854457502064, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03467528506293793, - -0.01830165565934405, - 0.04795162786943227 - ], - "translation_xyz_cm": [ - 3.4675285062937933, - -1.8301655659344052, - 4.795162786943227 - ], - "translation_norm_m": 0.06194097681985424, - "rotation_rpy_deg_xyz": [ - 0.2500771759506376, - 0.10120038624273704, - -0.3511335765010256 - ], - "rotation_angle_deg": 0.442978277706443, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04650045646911394, - 0.012626928199015452, - 0.025613521943092445 - ], - "translation_xyz_cm": [ - 4.650045646911394, - 1.2626928199015452, - 2.5613521943092445 - ], - "translation_norm_m": 0.05456907800126671, - "rotation_rpy_deg_xyz": [ - 0.34709251693925564, - 0.29424231129078426, - -0.3838949195377323 - ], - "rotation_angle_deg": 0.5959113296525195, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0055332266881600424, - 0.0213729282346789, - -0.009861035264755213 - ], - "translation_xyz_cm": [ - 0.5533226688160042, - 2.13729282346789, - -0.9861035264755214 - ], - "translation_norm_m": 0.024179716197673767, - "rotation_rpy_deg_xyz": [ - 0.24866433873639016, - 0.2317916318533378, - -0.0341590930790452 - ], - "rotation_angle_deg": 0.34170518454995, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03281322627871578, - 0.0016587133623240935, - -0.07049471452915668 - ], - "translation_xyz_cm": [ - -3.281322627871578, - 0.16587133623240935, - -7.049471452915668 - ], - "translation_norm_m": 0.07777508550547436, - "rotation_rpy_deg_xyz": [ - 0.49338048612825613, - 0.5219990112593001, - 0.5320886289188058 - ], - "rotation_angle_deg": 0.8925404499167059, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.031404281718908134, - -0.019237177506948006, - -0.05039654268608686 - ], - "translation_xyz_cm": [ - -3.1404281718908136, - -1.9237177506948004, - -5.039654268608686 - ], - "translation_norm_m": 0.062418822669327474, - "rotation_rpy_deg_xyz": [ - 0.4329895504693059, - 0.3675628568786115, - 0.5846731747698455 - ], - "rotation_angle_deg": 0.814123843782237, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038399731279221985, - -0.03635585097705207, - -0.0760934662644942 - ], - "translation_xyz_cm": [ - -3.8399731279221987, - -3.6355850977052073, - -7.609346626449421 - ], - "translation_norm_m": 0.09266338473597753, - "rotation_rpy_deg_xyz": [ - 0.5535519647174143, - 0.7876704292547586, - 0.49892185785439724 - ], - "rotation_angle_deg": 1.0825710430572544, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01312350509996326, - -0.009782260763087497, - -0.03053411651414376 - ], - "translation_xyz_cm": [ - -1.312350509996326, - -0.9782260763087497, - -3.053411651414376 - ], - "translation_norm_m": 0.034644642919867276, - "rotation_rpy_deg_xyz": [ - 0.29920522487343987, - 0.28984819678897566, - -0.08800523252935184 - ], - "rotation_angle_deg": 0.42592680856608056, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008034432197865593, - 0.016612132545862246, - -0.13086107925755863 - ], - "translation_xyz_cm": [ - 0.8034432197865593, - 1.6612132545862246, - -13.086107925755863 - ], - "translation_norm_m": 0.1321557305337776, - "rotation_rpy_deg_xyz": [ - -0.8494857483470171, - 0.6980579150878031, - 0.29020940620293917 - ], - "rotation_angle_deg": 1.1384746104914347, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0013352252405872678, - -0.0006744268660137109, - 0.0003259477141177355 - ], - "translation_xyz_cm": [ - 0.13352252405872678, - -0.0674426866013711, - 0.03259477141177355 - ], - "translation_norm_m": 0.0015309865946640357, - "rotation_rpy_deg_xyz": [ - 0.09279868962745053, - -0.28612432775716423, - -0.4804787082809953 - ], - "rotation_angle_deg": 0.5666703677321191, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010223387359974523, - 0.0209418871491317, - -0.06136486232941757 - ], - "translation_xyz_cm": [ - 1.0223387359974523, - 2.09418871491317, - -6.136486232941757 - ], - "translation_norm_m": 0.0656408913344984, - "rotation_rpy_deg_xyz": [ - 0.048386653755154566, - 0.027500476893906618, - 0.005954451336816827 - ], - "rotation_angle_deg": 0.055971971966886226, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012263002202483109, - 0.04114342566625595, - -0.10809827991284617 - ], - "translation_xyz_cm": [ - 1.2263002202483109, - 4.114342566625595, - -10.809827991284617 - ], - "translation_norm_m": 0.1163116538386798, - "rotation_rpy_deg_xyz": [ - -0.9675871085365938, - -0.17531250966360992, - 0.16612860346133385 - ], - "rotation_angle_deg": 0.9970279598010798, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00668383470953815, - 0.017215032488996473, - -0.05177655943492826 - ], - "translation_xyz_cm": [ - 0.668383470953815, - 1.7215032488996473, - -5.177655943492826 - ], - "translation_norm_m": 0.0549712933897347, - "rotation_rpy_deg_xyz": [ - -0.9562223115136043, - -0.06139276020998848, - 0.16480626488402633 - ], - "rotation_angle_deg": 0.9721737007040958, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0023687006259740517, - 0.010971268401535506, - 0.01817477920270082 - ], - "translation_xyz_cm": [ - -0.23687006259740517, - 1.0971268401535506, - 1.817477920270082 - ], - "translation_norm_m": 0.021361228243266996, - "rotation_rpy_deg_xyz": [ - -0.18342386889989107, - 1.6395943972343312, - 0.4731921792404563 - ], - "rotation_angle_deg": 1.7170587993517705, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03270285666162531, - -0.004369015554693156, - 0.2326206297579615 - ], - "translation_xyz_cm": [ - 3.2702856661625312, - -0.43690155546931564, - 23.262062975796148 - ], - "translation_norm_m": 0.23494876573359258, - "rotation_rpy_deg_xyz": [ - 0.024500017160899952, - -0.42159031146048764, - -0.2539557532533365 - ], - "rotation_angle_deg": 0.49273328458463955, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011305896689445927, - 0.026873579207242315, - 0.22292275238512355 - ], - "translation_xyz_cm": [ - -1.1305896689445927, - 2.6873579207242315, - 22.292275238512353 - ], - "translation_norm_m": 0.22482118692489697, - "rotation_rpy_deg_xyz": [ - 0.681218044507589, - -0.38546417297660784, - -0.6979143450767922 - ], - "rotation_angle_deg": 1.047147189411602, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0008233633212458291, - -0.0029882147541471227, - -0.043522002260380735 - ], - "translation_xyz_cm": [ - 0.08233633212458291, - -0.29882147541471227, - -4.352200226038073 - ], - "translation_norm_m": 0.04363223619444987, - "rotation_rpy_deg_xyz": [ - -0.5493984805754152, - 0.6431754084917372, - 0.089435925685316 - ], - "rotation_angle_deg": 0.8509173541406347, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -5.6546766625587e-05, - 0.027783753359931884, - 0.047571772006217414 - ], - "translation_xyz_cm": [ - -0.0056546766625587, - 2.7783753359931884, - 4.757177200621741 - ], - "translation_norm_m": 0.05509095787979978, - "rotation_rpy_deg_xyz": [ - -0.8560017333688674, - -0.05745183385124318, - -0.7405671175817861 - ], - "rotation_angle_deg": 1.1336245767915163, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01443808210121178, - -0.039448024246860225, - -0.021929844131010432 - ], - "translation_xyz_cm": [ - 1.443808210121178, - -3.9448024246860225, - -2.192984413101043 - ], - "translation_norm_m": 0.047386948576085976, - "rotation_rpy_deg_xyz": [ - 0.06523717676486462, - 0.10235760944953026, - -0.6465560966924323 - ], - "rotation_angle_deg": 0.657908010932712, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.007606089908610336, - -0.011659696628856797, - -0.023826319134542584 - ], - "translation_xyz_cm": [ - 0.7606089908610336, - -1.1659696628856797, - -2.3826319134542584 - ], - "translation_norm_m": 0.02759519183980986, - "rotation_rpy_deg_xyz": [ - -1.385116990184271, - -0.9853339182123925, - 0.15034426343513776 - ], - "rotation_angle_deg": 1.7054047074838854, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.005376603699022819, - 0.005319793796464037, - 0.05418917513271009 - ], - "translation_xyz_cm": [ - 0.5376603699022819, - 0.5319793796464036, - 5.418917513271009 - ], - "translation_norm_m": 0.054714484142106, - "rotation_rpy_deg_xyz": [ - -0.4308911777566878, - -0.34521040255469665, - -0.1398630873000363 - ], - "rotation_angle_deg": 0.5698784993516836, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.012643413789746205, - -0.026722015486996264, - 0.021850547260248668 - ], - "translation_xyz_cm": [ - -1.2643413789746205, - -2.6722015486996264, - 2.185054726024867 - ], - "translation_norm_m": 0.03676096352815542, - "rotation_rpy_deg_xyz": [ - 0.8577116808307673, - -0.30739720316708374, - -0.2154598168400179 - ], - "rotation_angle_deg": 0.9357302365302121, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011328902283608056, - 0.02224672331629307, - 0.04342381591302455 - ], - "translation_xyz_cm": [ - -1.1328902283608056, - 2.224672331629307, - 4.342381591302455 - ], - "translation_norm_m": 0.0500888062715761, - "rotation_rpy_deg_xyz": [ - 0.06729818816186765, - 1.1457222242371556, - -0.2825962472174885 - ], - "rotation_angle_deg": 1.182136446890146, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004484398538715517, - -0.027870768543897473, - -0.06151977292289944 - ], - "translation_xyz_cm": [ - -0.04484398538715517, - -2.7870768543897473, - -6.151977292289944 - ], - "translation_norm_m": 0.0675400866005897, - "rotation_rpy_deg_xyz": [ - 0.3905197642995209, - 0.2567911565563081, - -0.08903191762278209 - ], - "rotation_angle_deg": 0.4759512535508281, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019899419133884377, - 0.02045104170115486, - -0.049224045955585036 - ], - "translation_xyz_cm": [ - -1.9899419133884377, - 2.045104170115486, - -4.922404595558503 - ], - "translation_norm_m": 0.05689673706607371, - "rotation_rpy_deg_xyz": [ - -0.08299275153517802, - 0.04474532771825442, - 0.07060939997673661 - ], - "rotation_angle_deg": 0.11781427540665272, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.033748560996567756, - 0.025235618505753177, - -0.0750153271637038 - ], - "translation_xyz_cm": [ - -3.3748560996567756, - 2.5235618505753177, - -7.501532716370379 - ], - "translation_norm_m": 0.08604127567734268, - "rotation_rpy_deg_xyz": [ - 0.12578705101663182, - 0.6067611808641802, - 0.3162554597696284 - ], - "rotation_angle_deg": 0.6953967411037035, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009180016499000021, - 0.014205476809026618, - -0.03425249776827852 - ], - "translation_xyz_cm": [ - -0.9180016499000021, - 1.4205476809026618, - -3.425249776827852 - ], - "translation_norm_m": 0.038200809908425115, - "rotation_rpy_deg_xyz": [ - 0.36339638463845925, - 0.6674216313953211, - 0.24725516606214024 - ], - "rotation_angle_deg": 0.7984952341151029, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.006054514429228552, - 0.0034015886546279184, - 0.0453624791916232 - ], - "translation_xyz_cm": [ - 0.6054514429228552, - 0.34015886546279184, - 4.53624791916232 - ], - "translation_norm_m": 0.0458909846130967, - "rotation_rpy_deg_xyz": [ - 1.1901840530526848, - -0.28584587514441945, - -0.2852596780269641 - ], - "rotation_angle_deg": 1.2561525340780257, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.013556640361261252, - 0.012118577492022053, - 0.013945473701008695 - ], - "translation_xyz_cm": [ - -1.3556640361261252, - 1.2118577492022053, - 1.3945473701008695 - ], - "translation_norm_m": 0.022915467594187257, - "rotation_rpy_deg_xyz": [ - 1.147462921939667, - 0.09186085077562536, - 0.3941478502599244 - ], - "rotation_angle_deg": 1.2164421401329297, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.005731986791654542, - 0.01328176450613805, - 0.008699435797877117 - ], - "translation_xyz_cm": [ - 0.5731986791654542, - 1.328176450613805, - 0.8699435797877118 - ], - "translation_norm_m": 0.0168801991747016, - "rotation_rpy_deg_xyz": [ - 0.665568569576474, - 0.7487338866459836, - -0.5061793832200092 - ], - "rotation_angle_deg": 1.1243625831862627, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005607982683432766, - 0.039529724683462386, - 0.06125749333411372 - ], - "translation_xyz_cm": [ - -0.5607982683432766, - 3.9529724683462386, - 6.125749333411372 - ], - "translation_norm_m": 0.07311996370969424, - "rotation_rpy_deg_xyz": [ - -1.241660734058652, - -0.5637973044846311, - 0.6116227635043595 - ], - "rotation_angle_deg": 1.4920349270168083, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.020951464549602505, - 0.022999110685020252, - 0.04441800053181093 - ], - "translation_xyz_cm": [ - 2.0951464549602505, - 2.299911068502025, - 4.441800053181093 - ], - "translation_norm_m": 0.05422989701556715, - "rotation_rpy_deg_xyz": [ - -0.3863502777535908, - -0.31141516637077304, - 0.49304271452082143 - ], - "rotation_angle_deg": 0.6987845408478884, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004731531518500365, - -0.000647962159230242, - 0.029562220615702947 - ], - "translation_xyz_cm": [ - -0.4731531518500365, - -0.0647962159230242, - 2.9562220615702945 - ], - "translation_norm_m": 0.02994548602380414, - "rotation_rpy_deg_xyz": [ - 0.49629952118216786, - -1.3066158998839483, - 0.23524671474336992 - ], - "rotation_angle_deg": 1.4182906758604152, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016591175846238038, - 0.006165105389012604, - 0.033487827139727255 - ], - "translation_xyz_cm": [ - -1.6591175846238038, - 0.6165105389012604, - 3.3487827139727253 - ], - "translation_norm_m": 0.03787756865162649, - "rotation_rpy_deg_xyz": [ - -0.7143759278915505, - -1.37460151036425, - 0.17568667889663378 - ], - "rotation_angle_deg": 1.5581048315237462, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.005049115681996619, - 0.017870082218921057, - -0.05187910077581297 - ], - "translation_xyz_cm": [ - 0.5049115681996619, - 1.7870082218921057, - -5.1879100775812965 - ], - "translation_norm_m": 0.05510240017447643, - "rotation_rpy_deg_xyz": [ - -0.2677790844912152, - -0.7198679579644974, - 0.0878280657811058 - ], - "rotation_angle_deg": 0.7728730407574438, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006324956966257345, - 0.002606988379937336, - -0.018629328651677983 - ], - "translation_xyz_cm": [ - -0.6324956966257345, - 0.2606988379937336, - -1.8629328651677983 - ], - "translation_norm_m": 0.019845738964582946, - "rotation_rpy_deg_xyz": [ - 0.07683111402387942, - -0.2815027483362668, - -0.05025715204936589 - ], - "rotation_angle_deg": 0.29606352391378077, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008936755123347462, - 0.02142789527811284, - -0.02421553863783999 - ], - "translation_xyz_cm": [ - 0.8936755123347462, - 2.142789527811284, - -2.4215538637839993 - ], - "translation_norm_m": 0.033547169771907276, - "rotation_rpy_deg_xyz": [ - 0.9689368388115391, - 0.11284882462038442, - -0.1475498246220297 - ], - "rotation_angle_deg": 0.9867244603067713, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0031501776785451963, - 0.0013919623940481518, - 0.02554577035837033 - ], - "translation_xyz_cm": [ - 0.3150177678545196, - 0.13919623940481518, - 2.554577035837033 - ], - "translation_norm_m": 0.02577688037593845, - "rotation_rpy_deg_xyz": [ - 1.2042230258076034, - -0.18340302290430344, - 0.020165104232538138 - ], - "rotation_angle_deg": 1.2183073803580622, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.004690167830628589, - "improved_pairs": 13, - "worsened_pairs": 26, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.02309094892649588, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -0.00132483596826191, - 0.7204966196317207 - ], - "rotation_rpy_deg_xyz": [ - -0.6851396936080634, - 1.2041171781580922, - -0.833409656117373 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07926481666577584, - "median": 0.0534580084047171, - "p90": 0.11872900120051573, - "p95": 0.14474158067798823, - "max": 0.2310876369628974 - }, - "rotation_deg": { - "rms": 0.9754404878748625, - "median": 0.7895098434536542, - "p90": 1.4542673386909655, - "p95": 1.5681764627531727, - "max": 1.7436332376803183 - }, - "normalized_pair_score": { - "rms": 2.5137822192795105, - "median": 2.375826284723977, - "p90": 3.3218595045907957, - "p95": 3.647913562962063, - "max": 5.0454645860236935 - }, - "normalized_global_rms": 2.5137822192795105 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.019849501771051492, - -0.014225119869694547, - 0.13388568757836983 - ], - "translation_xyz_cm": [ - 1.9849501771051492, - -1.4225119869694547, - 13.388568757836982 - ], - "translation_norm_m": 0.13609457775458583, - "rotation_rpy_deg_xyz": [ - -0.30814802989837486, - -0.2553853612285898, - -0.3465566070631916 - ], - "rotation_angle_deg": 0.5298619890141043, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.652705907802981, - "median": 0.7642140295928858, - "p90": 2.3730818708821753, - "p95": 3.9393965271141544, - "max": 5.432408856778532 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.019849501771051492, - -0.014225119869694547, - 0.13388568757836983 - ], - "translation_xyz_cm": [ - 1.9849501771051492, - -1.4225119869694547, - 13.388568757836982 - ], - "translation_norm_m": 0.13609457775458583, - "rotation_rpy_deg_xyz": [ - -0.30814802989837486, - -0.2553853612285898, - -0.3465566070631916 - ], - "rotation_angle_deg": 0.5298619890141043, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03171040067575015, - 0.009422119895287961, - 0.11079741994972288 - ], - "translation_xyz_cm": [ - 3.171040067575015, - 0.9422119895287961, - 11.079741994972288 - ], - "translation_norm_m": 0.11563042039988027, - "rotation_rpy_deg_xyz": [ - -0.25199339672410914, - -0.3608228159641627, - -0.4025035401863851 - ], - "rotation_angle_deg": 0.5969427266670555, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034046736055924454, - -0.018218222792134975, - 0.048844107601041756 - ], - "translation_xyz_cm": [ - 3.4046736055924454, - -1.8218222792134975, - 4.884410760104176 - ], - "translation_norm_m": 0.06226420099148304, - "rotation_rpy_deg_xyz": [ - 0.2559468722643658, - 0.0559290578346524, - -0.3518306890513121 - ], - "rotation_angle_deg": 0.4387589038931823, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.045183224004385236, - 0.0124474119700132, - 0.027143963448575968 - ], - "translation_xyz_cm": [ - 4.518322400438524, - 1.24474119700132, - 2.714396344857597 - ], - "translation_norm_m": 0.05415954715356573, - "rotation_rpy_deg_xyz": [ - 0.37278014805454507, - 0.19905149467537275, - -0.38525812242251006 - ], - "rotation_angle_deg": 0.5722835691407653, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.004848507119116668, - 0.021274477483793436, - -0.009151694612596507 - ], - "translation_xyz_cm": [ - 0.4848507119116668, - 2.1274477483793435, - -0.9151694612596507 - ], - "translation_norm_m": 0.02366146503864008, - "rotation_rpy_deg_xyz": [ - 0.2566485820405728, - 0.17867899954417002, - -0.03495353671788429 - ], - "rotation_angle_deg": 0.31471312103176363, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.034484381660623405, - 0.0007872247001593502, - -0.06967327514946207 - ], - "translation_xyz_cm": [ - -3.4484381660623407, - 0.07872247001593502, - -6.9673275149462075 - ], - "translation_norm_m": 0.07774418030500245, - "rotation_rpy_deg_xyz": [ - 0.5530457420079644, - 0.38237454735918597, - 0.530152881090796 - ], - "rotation_angle_deg": 0.8550853084401805, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03255708121599314, - -0.019712782578652582, - -0.050083477735733926 - ], - "translation_xyz_cm": [ - -3.255708121599314, - -1.9712782578652583, - -5.008347773573393 - ], - "translation_norm_m": 0.06290399094178173, - "rotation_rpy_deg_xyz": [ - 0.4597898106813386, - 0.27041855418523675, - 0.5831477058430078 - ], - "rotation_angle_deg": 0.7895098434536542, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04010277096262335, - -0.037361836537912085, - -0.07513426564667143 - ], - "translation_xyz_cm": [ - -4.010277096262335, - -3.7361836537912083, - -7.513426564667143 - ], - "translation_norm_m": 0.09300159645205495, - "rotation_rpy_deg_xyz": [ - 0.6206183263311692, - 0.6411119815189987, - 0.4968198522178069 - ], - "rotation_angle_deg": 1.0195893846213122, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013910624897495366, - -0.00998170162076506, - -0.029736917394995493 - ], - "translation_xyz_cm": [ - -1.3910624897495367, - -0.998170162076506, - -2.9736917394995492 - ], - "translation_norm_m": 0.034313614039351605, - "rotation_rpy_deg_xyz": [ - 0.3102778161135205, - 0.227067374414036, - -0.08896703136558141 - ], - "rotation_angle_deg": 0.39478638692398543, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.007191226776678716, - 0.015959048435487122, - -0.12994968731393539 - ], - "translation_xyz_cm": [ - 0.7191226776678716, - 1.5959048435487122, - -12.994968731393538 - ], - "translation_norm_m": 0.13112332440305738, - "rotation_rpy_deg_xyz": [ - -0.8305893633959313, - 0.6160705168776986, - 0.2906845636353352 - ], - "rotation_angle_deg": 1.0754097896643824, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.00041195648836467313, - -0.0013726150113285707, - 0.0026396275875124574 - ], - "translation_xyz_cm": [ - -0.04119564883646731, - -0.13726150113285707, - 0.26396275875124575 - ], - "translation_norm_m": 0.0030035668659757057, - "rotation_rpy_deg_xyz": [ - 0.146486325570272, - -0.41959318572956505, - -0.4814594892834861 - ], - "rotation_angle_deg": 0.6548298831900574, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009672212516376455, - 0.020617811833847255, - -0.059947857623197015 - ], - "translation_xyz_cm": [ - 0.9672212516376455, - 2.0617811833847255, - -5.994785762319702 - ], - "translation_norm_m": 0.06412793068070247, - "rotation_rpy_deg_xyz": [ - 0.05444269237917539, - -0.01851396790708448, - 0.005409706346117727 - ], - "rotation_angle_deg": 0.05775927478328968, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011177358228270151, - 0.04043414039103732, - -0.10512749640195788 - ], - "translation_xyz_cm": [ - 1.1177358228270151, - 4.043414039103732, - -10.51274964019579 - ], - "translation_norm_m": 0.11318853098202512, - "rotation_rpy_deg_xyz": [ - -0.9403656569245651, - -0.27318173898733006, - 0.16698853380712517 - ], - "rotation_angle_deg": 0.9930004731694305, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006000298362307921, - 0.01692175179142985, - -0.049748626679505414 - ], - "translation_xyz_cm": [ - 0.6000298362307921, - 1.692175179142985, - -4.974862667950541 - ], - "translation_norm_m": 0.05288927226408274, - "rotation_rpy_deg_xyz": [ - -0.9475740693291651, - -0.11673004617688458, - 0.16514888159537355 - ], - "rotation_angle_deg": 0.9687501791312266, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.004937683582914909, - 0.008033115242936484, - 0.02311811884494326 - ], - "translation_xyz_cm": [ - -0.4937683582914909, - 0.8033115242936484, - 2.3118118844943263 - ], - "translation_norm_m": 0.024967160002695672, - "rotation_rpy_deg_xyz": [ - 0.042018351304118705, - 1.4440930127863265, - 0.4754869621153203 - ], - "rotation_angle_deg": 1.5207703283318257, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.029696436167651385, - -0.008016651585637913, - 0.2290313317722948 - ], - "translation_xyz_cm": [ - 2.9696436167651385, - -0.8016651585637913, - 22.903133177229478 - ], - "translation_norm_m": 0.2310876369628974, - "rotation_rpy_deg_xyz": [ - 0.29618228304264616, - -0.6054154344304503, - -0.25128457238015406 - ], - "rotation_angle_deg": 0.7187543132684605, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.01430848913479954, - 0.02617641385263214, - 0.2205562666996539 - ], - "translation_xyz_cm": [ - -1.430848913479954, - 2.617641385263214, - 22.05562666996539 - ], - "translation_norm_m": 0.22256460698860858, - "rotation_rpy_deg_xyz": [ - 0.7841459701425789, - -0.5574209938545415, - -0.7003096739248279 - ], - "rotation_angle_deg": 1.1877195770910876, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0009537930911136527, - -0.0038274981851991186, - -0.03801437221635509 - ], - "translation_xyz_cm": [ - -0.09537930911136527, - -0.38274981851991186, - -3.801437221635509 - ], - "translation_norm_m": 0.03821847666537677, - "rotation_rpy_deg_xyz": [ - -0.4887610929731296, - 0.5026091908766562, - 0.0900560597482801 - ], - "rotation_angle_deg": 0.7071053536689378, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.001466777115332718, - 0.02738015603570676, - 0.04677867115379 - ], - "translation_xyz_cm": [ - -0.1466777115332718, - 2.738015603570676, - 4.677867115379001 - ], - "translation_norm_m": 0.05422239808935177, - "rotation_rpy_deg_xyz": [ - -0.8201055585745557, - -0.168902858691228, - -0.7397105897258652 - ], - "rotation_angle_deg": 1.118056866682163, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012335445245211574, - -0.04057733084861148, - -0.01198019357752817 - ], - "translation_xyz_cm": [ - 1.2335445245211574, - -4.057733084861148, - -1.1980193577528169 - ], - "translation_norm_m": 0.04407048929102486, - "rotation_rpy_deg_xyz": [ - 0.14129867456026288, - -0.051731509814885106, - -0.6473485755879164 - ], - "rotation_angle_deg": 0.6645440648996449, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0060419819554002885, - -0.012003428306194663, - -0.017683158201969085 - ], - "translation_xyz_cm": [ - 0.6041981955400288, - -1.2003428306194663, - -1.7683158201969085 - ], - "translation_norm_m": 0.02220995094652855, - "rotation_rpy_deg_xyz": [ - -1.3533217857456405, - -1.0906978392006157, - 0.15208684615746604 - ], - "rotation_angle_deg": 1.7436332376803183, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0025879627902243296, - 0.0034435310238590255, - 0.058854201051244344 - ], - "translation_xyz_cm": [ - 0.25879627902243296, - 0.34435310238590255, - 5.885420105124434 - ], - "translation_norm_m": 0.05901162969022425, - "rotation_rpy_deg_xyz": [ - -0.27916531777482795, - -0.5364160981949373, - -0.1381128345218774 - ], - "rotation_angle_deg": 0.6205730309625402, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.013362478307735515, - -0.031966449102918904, - 0.025848705286129717 - ], - "translation_xyz_cm": [ - -1.3362478307735515, - -3.1966449102918904, - 2.5848705286129716 - ], - "translation_norm_m": 0.043226904350686476, - "rotation_rpy_deg_xyz": [ - 1.2520174008990141, - -0.35149897142138253, - -0.20859355944335656 - ], - "rotation_angle_deg": 1.316435111493718, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.013233207502184818, - 0.021658658658626262, - 0.04811095260134757 - ], - "translation_xyz_cm": [ - -1.3233207502184818, - 2.165865865862626, - 4.811095260134756 - ], - "translation_norm_m": 0.054395579194415046, - "rotation_rpy_deg_xyz": [ - 0.12363392818794307, - 1.0094417166502565, - -0.28350797755827994 - ], - "rotation_angle_deg": 1.0560538481567812, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0030482170676493503, - -0.030689363671338565, - -0.05012233379164305 - ], - "translation_xyz_cm": [ - -0.30482170676493503, - -3.0689363671338565, - -5.012233379164305 - ], - "translation_norm_m": 0.05885046316354755, - "rotation_rpy_deg_xyz": [ - 0.5948424254966925, - 0.059709044671339154, - -0.08913753781674988 - ], - "rotation_angle_deg": 0.6044860079470344, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.02210238881273008, - 0.018763270783825114, - -0.04506933872788373 - ], - "translation_xyz_cm": [ - -2.210238881273008, - 1.8763270783825114, - -4.506933872788373 - ], - "translation_norm_m": 0.05358937595368098, - "rotation_rpy_deg_xyz": [ - 0.040815904615290846, - -0.13729541068995801, - 0.07078107333079628 - ], - "rotation_angle_deg": 0.15979001086589728, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03597995533668663, - 0.022318091205329793, - -0.0726118570796889 - ], - "translation_xyz_cm": [ - -3.597995533668663, - 2.2318091205329793, - -7.26118570796889 - ], - "translation_norm_m": 0.08405436436997517, - "rotation_rpy_deg_xyz": [ - 0.35618150382014435, - 0.4119544610244835, - 0.31760355603095375 - ], - "rotation_angle_deg": 0.6297849582040155, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010472543065393247, - 0.013735207746829459, - -0.03200700620779637 - ], - "translation_xyz_cm": [ - -1.0472543065393247, - 1.3735207746829459, - -3.200700620779637 - ], - "translation_norm_m": 0.03637002249780711, - "rotation_rpy_deg_xyz": [ - 0.393691354318348, - 0.5644454148447818, - 0.24579977190975077 - ], - "rotation_angle_deg": 0.730105294658624, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.003916851645858532, - -0.00048227348370311063, - 0.044909375477078975 - ], - "translation_xyz_cm": [ - 0.39168516458585323, - -0.04822734837031106, - 4.490937547707897 - ], - "translation_norm_m": 0.04508243915617266, - "rotation_rpy_deg_xyz": [ - 1.4983806857899884, - -0.4512037738909708, - -0.28493351139568235 - ], - "rotation_angle_deg": 1.589508679287657, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.015068737106081809, - 0.007136663162194301, - 0.023877621934465465 - ], - "translation_xyz_cm": [ - -1.5068737106081809, - 0.7136663162194301, - 2.3877621934465463 - ], - "translation_norm_m": 0.029122836886335338, - "rotation_rpy_deg_xyz": [ - 1.5142786009379081, - -0.01561244373027908, - 0.3978828123183685 - ], - "rotation_angle_deg": 1.5658062164715634, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0041161809153633655, - 0.00833703704333666, - 0.01905445417864772 - ], - "translation_xyz_cm": [ - 0.41161809153633655, - 0.8337037043336659, - 1.905445417864772 - ], - "translation_norm_m": 0.021201918687613033, - "rotation_rpy_deg_xyz": [ - 1.0289910942817144, - 0.6362507122401511, - -0.5017532590073943 - ], - "rotation_angle_deg": 1.3119097059409317, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00399653435270686, - 0.03926719918564536, - 0.05073249947913065 - ], - "translation_xyz_cm": [ - -0.399653435270686, - 3.9267199185645363, - 5.073249947913065 - ], - "translation_norm_m": 0.0642780811950505, - "rotation_rpy_deg_xyz": [ - -1.2175190343481954, - -0.4655782787448729, - 0.6113676460691083 - ], - "rotation_angle_deg": 1.43764159128075, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02394546482894988, - 0.02140714709820024, - 0.02709210927218765 - ], - "translation_xyz_cm": [ - 2.394546482894988, - 2.140714709820024, - 2.709210927218765 - ], - "translation_norm_m": 0.04201944332775739, - "rotation_rpy_deg_xyz": [ - -0.24392209919550858, - -0.11697433807852226, - 0.4976283574490649 - ], - "rotation_angle_deg": 0.5661860777216423, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.002914070482875619, - -0.0010403466687580742, - 0.024017951765459428 - ], - "translation_xyz_cm": [ - -0.2914070482875619, - -0.10403466687580742, - 2.4017951765459427 - ], - "translation_norm_m": 0.024216443483267697, - "rotation_rpy_deg_xyz": [ - 0.5381161438563082, - -1.18122318248681, - 0.23897812117449893 - ], - "rotation_angle_deg": 1.3208354328670546, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.013685425455202793, - 0.0037797437792899125, - 0.024334491041600292 - ], - "translation_xyz_cm": [ - -1.3685425455202793, - 0.37797437792899125, - 2.4334491041600295 - ], - "translation_norm_m": 0.02817347666122728, - "rotation_rpy_deg_xyz": [ - -0.5221298987219626, - -1.1718417327434323, - 0.18031652784155 - ], - "rotation_angle_deg": 1.2947626390058276, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007164148152440153, - 0.014185015837851367, - -0.05104134568688994 - ], - "translation_xyz_cm": [ - 0.7164148152440153, - 1.4185015837851367, - -5.104134568688994 - ], - "translation_norm_m": 0.0534580084047171, - "rotation_rpy_deg_xyz": [ - 0.029034605698425885, - -0.5421285997962119, - 0.09612747436081819 - ], - "rotation_angle_deg": 0.551373966930815, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.004294608879272577, - 0.0017823689306075696, - -0.02383106684546112 - ], - "translation_xyz_cm": [ - -0.4294608879272577, - 0.17823689306075696, - -2.383106684546112 - ], - "translation_norm_m": 0.024280449983959486, - "rotation_rpy_deg_xyz": [ - 0.14612143402575795, - -0.12720760782925722, - -0.04638723976593878 - ], - "rotation_angle_deg": 0.19917320434172409, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011270820838496842, - 0.0191911378546894, - -0.02062055773395971 - ], - "translation_xyz_cm": [ - 1.1270820838496842, - 1.91911378546894, - -2.0620557733959712 - ], - "translation_norm_m": 0.030340378636245672, - "rotation_rpy_deg_xyz": [ - 1.1355389163061824, - 0.31274551162313063, - -0.1376386007352406 - ], - "rotation_angle_deg": 1.186192236689091, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004280670362076577, - 0.0012480724976401403, - 0.024407256277881144 - ], - "translation_xyz_cm": [ - 0.42806703620765774, - 0.12480724976401403, - 2.4407256277881144 - ], - "translation_norm_m": 0.024811206796975738, - "rotation_rpy_deg_xyz": [ - 1.2223365153658456, - -0.09730865905399282, - 0.023549905487150028 - ], - "rotation_angle_deg": 1.2264496069558513, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.014640883602566213, - "improved_pairs": 23, - "worsened_pairs": 16, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.01407846496018239, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152137045299, - 0.0024476764333135033, - 0.7182275658581914 - ], - "rotation_rpy_deg_xyz": [ - -0.9866396137764585, - 1.299726385041302, - -0.8397351699715397 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08100204146829142, - "median": 0.05343778582472472, - "p90": 0.12199302000464023, - "p95": 0.14384165085377676, - "max": 0.23597491675483537 - }, - "rotation_deg": { - "rms": 0.9768217811391146, - "median": 0.8715610720954865, - "p90": 1.455213079418749, - "p95": 1.6389320484513092, - "max": 1.921236302703376 - }, - "normalized_pair_score": { - "rms": 2.5379628557651293, - "median": 2.3109672385727533, - "p90": 3.538019662607156, - "p95": 3.9470185969464424, - "max": 4.8331433545962605 - }, - "normalized_global_rms": 2.5379628557651293 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021872302193916227, - -0.015032568685410475, - 0.12910289996150243 - ], - "translation_xyz_cm": [ - 2.1872302193916227, - -1.5032568685410475, - 12.910289996150242 - ], - "translation_norm_m": 0.13180263465884617, - "rotation_rpy_deg_xyz": [ - -0.2970010410852404, - -0.11190881242044907, - -0.3449773488089977 - ], - "rotation_angle_deg": 0.4689801268726104, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7058242505297496, - "median": 0.6958135424032661, - "p90": 2.316636492319242, - "p95": 3.9421963521214107, - "max": 5.747677749152345 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021872302193916227, - -0.015032568685410475, - 0.12910289996150243 - ], - "translation_xyz_cm": [ - 2.1872302193916227, - -1.5032568685410475, - 12.910289996150242 - ], - "translation_norm_m": 0.13180263465884617, - "rotation_rpy_deg_xyz": [ - -0.2970010410852404, - -0.11190881242044907, - -0.3449773488089977 - ], - "rotation_angle_deg": 0.4689801268726104, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03498370747598811, - 0.008951795248228978, - 0.10496774524476647 - ], - "translation_xyz_cm": [ - 3.4983707475988113, - 0.8951795248228978, - 10.496774524476647 - ], - "translation_norm_m": 0.11100550422705135, - "rotation_rpy_deg_xyz": [ - -0.26486001450683555, - -0.13588063496860622, - -0.40051735698137125 - ], - "rotation_angle_deg": 0.49927919220838957, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03496452832672825, - -0.018619776612753602, - 0.04623233875336642 - ], - "translation_xyz_cm": [ - 3.496452832672825, - -1.8619776612753602, - 4.623233875336642 - ], - "translation_norm_m": 0.06088220978927633, - "rotation_rpy_deg_xyz": [ - 0.2697752888100495, - 0.12676116120303882, - -0.35016998967932783 - ], - "rotation_angle_deg": 0.46008131139835645, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.047255567120638164, - 0.012107973161620822, - 0.023376992584938715 - ], - "translation_xyz_cm": [ - 4.725556712063817, - 1.2107973161620822, - 2.3376992584938714 - ], - "translation_norm_m": 0.054094134804911605, - "rotation_rpy_deg_xyz": [ - 0.3818429301188199, - 0.3546605456646198, - -0.38176494558513185 - ], - "rotation_angle_deg": 0.6467097270108282, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00591999729698226, - 0.021089978234940077, - -0.010334661013449348 - ], - "translation_xyz_cm": [ - 0.591999729698226, - 2.1089978234940077, - -1.0334661013449349 - ], - "translation_norm_m": 0.02422062691611085, - "rotation_rpy_deg_xyz": [ - 0.27122689110868015, - 0.26232951774372587, - -0.033029119834606026 - ], - "rotation_angle_deg": 0.3788305805197378, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031547376724226785, - 0.0012796843004821978, - -0.07142133246324403 - ], - "translation_xyz_cm": [ - -3.1547376724226783, - 0.12796843004821978, - -7.142133246324403 - ], - "translation_norm_m": 0.07808893200008835, - "rotation_rpy_deg_xyz": [ - 0.5333686544895924, - 0.6216102263213674, - 0.5354813710167988 - ], - "rotation_angle_deg": 0.9769930434417843, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030589018497878373, - -0.01956294097102318, - -0.05091698877353057 - ], - "translation_xyz_cm": [ - -3.058901849787837, - -1.956294097102318, - -5.091698877353057 - ], - "translation_norm_m": 0.06253748042464712, - "rotation_rpy_deg_xyz": [ - 0.46816353767120233, - 0.4295127232043098, - 0.5869402857446643 - ], - "rotation_angle_deg": 0.8637665922441115, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03705477865138075, - -0.03668153959872644, - -0.0771926541426014 - ], - "translation_xyz_cm": [ - -3.705477865138075, - -3.6681539598726443, - -7.71926541426014 - ], - "translation_norm_m": 0.0931520145880648, - "rotation_rpy_deg_xyz": [ - 0.5933203855673373, - 0.8944497464837455, - 0.5026029737462928 - ], - "rotation_angle_deg": 1.183219904212373, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01263738333154036, - -0.010066511952241064, - -0.0309941871296455 - ], - "translation_xyz_cm": [ - -1.263738333154036, - -1.0066511952241064, - -3.09941871296455 - ], - "translation_norm_m": 0.03495250715156767, - "rotation_rpy_deg_xyz": [ - 0.3250585990923554, - 0.3267621302031689, - -0.0866367111243534 - ], - "rotation_angle_deg": 0.4691511328658994, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008807822440432655, - 0.01653091532011708, - -0.13421145579441998 - ], - "translation_xyz_cm": [ - 0.8807822440432655, - 1.6530915320117079, - -13.421145579441998 - ], - "translation_norm_m": 0.13551222735945498, - "rotation_rpy_deg_xyz": [ - -0.8179398443254622, - 0.7484997951006033, - 0.29098780790463874 - ], - "rotation_angle_deg": 1.1476273776843582, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0025212585691049005, - -0.0011749495148111189, - -0.00021474763538229143 - ], - "translation_xyz_cm": [ - 0.25212585691049005, - -0.11749495148111189, - -0.021474763538229143 - ], - "translation_norm_m": 0.0027898687570461194, - "rotation_rpy_deg_xyz": [ - 0.13266041200791756, - -0.19257318409503085, - -0.47789582805506553 - ], - "rotation_angle_deg": 0.5318404107794465, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010666924831950364, - 0.02086016614094599, - -0.06287885550192372 - ], - "translation_xyz_cm": [ - 1.0666924831950364, - 2.086016614094599, - -6.287885550192372 - ], - "translation_norm_m": 0.06710201402365024, - "rotation_rpy_deg_xyz": [ - 0.06836113385751648, - 0.05352754166262119, - 0.006842212300855938 - ], - "rotation_angle_deg": 0.08709087713498583, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013208673449955466, - 0.040997884226590564, - -0.11151082185080909 - ], - "translation_xyz_cm": [ - 1.3208673449955466, - 4.099788422659056, - -11.15108218508091 - ], - "translation_norm_m": 0.1195406163410887, - "rotation_rpy_deg_xyz": [ - -0.9322805897351686, - -0.11275930855999779, - 0.16688400281356514 - ], - "rotation_angle_deg": 0.9536272521242378, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007194824968473568, - 0.017046649838138195, - -0.05370781206172452 - ], - "translation_xyz_cm": [ - 0.7194824968473568, - 1.7046649838138195, - -5.3707812061724525 - ], - "translation_norm_m": 0.0568056586396865, - "rotation_rpy_deg_xyz": [ - -0.9328863417491617, - -0.029397038165186046, - 0.1653108227436858 - ], - "rotation_angle_deg": 0.9478338634395149, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0003099509493385, - 0.011189392642213525, - 0.011988687963139826 - ], - "translation_xyz_cm": [ - 0.030995094933849998, - 1.1189392642213525, - 1.1988687963139826 - ], - "translation_norm_m": 0.01640204915155883, - "rotation_rpy_deg_xyz": [ - -0.19834464267731342, - 1.8500238169202934, - 0.475602336486353 - ], - "rotation_angle_deg": 1.921236302703376, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03609367995265489, - -0.004077517849049972, - 0.2331625644333101 - ], - "translation_xyz_cm": [ - 3.609367995265489, - -0.4077517849049972, - 23.31625644333101 - ], - "translation_norm_m": 0.23597491675483537, - "rotation_rpy_deg_xyz": [ - -0.019521811989637643, - -0.19384658238974423, - -0.251186118397094 - ], - "rotation_angle_deg": 0.3179128713214332, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009235015734691654, - 0.025887880001989494, - 0.21707325975069583 - ], - "translation_xyz_cm": [ - -0.9235015734691654, - 2.5887880001989494, - 21.707325975069583 - ], - "translation_norm_m": 0.21880646230267164, - "rotation_rpy_deg_xyz": [ - 0.7156909985785658, - -0.2480942889029289, - -0.693241401730359 - ], - "rotation_angle_deg": 1.0257640454697428, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002150227988608977, - -0.0033887297596324473, - -0.05038280509424025 - ], - "translation_xyz_cm": [ - 0.2150227988608977, - -0.3388729759632447, - -5.038280509424025 - ], - "translation_norm_m": 0.05054239823109918, - "rotation_rpy_deg_xyz": [ - -0.5094356779280086, - 0.7437720580333383, - 0.09102165129079781 - ], - "rotation_angle_deg": 0.9064240989881033, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0009846231724117693, - 0.027285182445507594, - 0.04177740441054856 - ], - "translation_xyz_cm": [ - 0.09846231724117693, - 2.7285182445507594, - 4.177740441054856 - ], - "translation_norm_m": 0.0499079370757679, - "rotation_rpy_deg_xyz": [ - -0.818242116560719, - 0.016227478079622576, - -0.7396158616753039 - ], - "rotation_angle_deg": 1.1030115174582322, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015954050616062698, - -0.03983414479500058, - -0.026212325547745104 - ], - "translation_xyz_cm": [ - 1.5954050616062698, - -3.983414479500058, - -2.6212325547745103 - ], - "translation_norm_m": 0.050282967625528356, - "rotation_rpy_deg_xyz": [ - 0.10423182220160881, - 0.21740706144047997, - -0.643655303003996 - ], - "rotation_angle_deg": 0.6875145062858429, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.008343840747982334, - -0.012098566759296325, - -0.020505308164598418 - ], - "translation_xyz_cm": [ - 0.8343840747982334, - -1.2098566759296325, - -2.0505308164598417 - ], - "translation_norm_m": 0.025228211569233102, - "rotation_rpy_deg_xyz": [ - -1.348363055209726, - -0.9167228122015666, - 0.15063076472013687 - ], - "rotation_angle_deg": 1.6364178282622448, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0076637958147025564, - 0.00492740969514413, - 0.05265533041635858 - ], - "translation_xyz_cm": [ - 0.7663795814702556, - 0.49274096951441304, - 5.265533041635858 - ], - "translation_norm_m": 0.05343778582472472, - "rotation_rpy_deg_xyz": [ - -0.4112069376050002, - -0.17374019652525935, - -0.13789233850405208 - ], - "rotation_angle_deg": 0.46740005692383657, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.009600880370153497, - -0.024258806533743793, - 0.014661676588050829 - ], - "translation_xyz_cm": [ - -0.9600880370153497, - -2.4258806533743793, - 1.466167658805083 - ], - "translation_norm_m": 0.029927100739901402, - "rotation_rpy_deg_xyz": [ - 0.6824451978797951, - -0.08824484625371838, - -0.21275985988317453 - ], - "rotation_angle_deg": 0.7201118634070781, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010121112486917383, - 0.021694605032705372, - 0.03593642001612414 - ], - "translation_xyz_cm": [ - -1.0121112486917383, - 2.169460503270537, - 3.593642001612414 - ], - "translation_norm_m": 0.04318007745561844, - "rotation_rpy_deg_xyz": [ - 0.10729396651947076, - 1.2420153423879607, - -0.28000389083202315 - ], - "rotation_angle_deg": 1.2779530448915686, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021431186214568854, - -0.027613027287897385, - -0.06904512519429185 - ], - "translation_xyz_cm": [ - 0.21431186214568854, - -2.7613027287897385, - -6.9045125194291845 - ], - "translation_norm_m": 0.0743928863973111, - "rotation_rpy_deg_xyz": [ - 0.38687187420754865, - 0.45744081727673186, - -0.08447254204740909 - ], - "rotation_angle_deg": 0.6052417791756737, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.018039551125814013, - 0.02020098018117611, - -0.0485903889397746 - ], - "translation_xyz_cm": [ - -1.8039551125814013, - 2.020098018117611, - -4.85903889397746 - ], - "translation_norm_m": 0.05562850800102136, - "rotation_rpy_deg_xyz": [ - -0.05390869285858829, - 0.1976489171521654, - 0.07355930791969285 - ], - "rotation_angle_deg": 0.2177059580935924, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.031210753515040324, - 0.025574717242113354, - -0.07512339665010188 - ], - "translation_xyz_cm": [ - -3.1210753515040324, - 2.5574717242113354, - -7.512339665010188 - ], - "translation_norm_m": 0.08527427526070915, - "rotation_rpy_deg_xyz": [ - 0.10798255021463024, - 0.8193236744650109, - 0.3197722520822767 - ], - "rotation_angle_deg": 0.885838621632559, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00831045121578311, - 0.013843546864520606, - -0.036820522286788414 - ], - "translation_xyz_cm": [ - -0.831045121578311, - 1.3843546864520606, - -3.6820522286788413 - ], - "translation_norm_m": 0.04020520178623621, - "rotation_rpy_deg_xyz": [ - 0.39974613309119217, - 0.7340386883927469, - 0.24958045435644907 - ], - "rotation_angle_deg": 0.8715610720954865, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.00894739298445102, - 0.0040912593494293326, - 0.0506196002321747 - ], - "translation_xyz_cm": [ - 0.8947392984451019, - 0.40912593494293326, - 5.06196002321747 - ], - "translation_norm_m": 0.05156683209144883, - "rotation_rpy_deg_xyz": [ - 1.1186499455221801, - -0.049201371137048366, - -0.2781843838826371 - ], - "rotation_angle_deg": 1.153653006460214, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01044869066002807, - 0.014058936571188063, - 0.005674979032376112 - ], - "translation_xyz_cm": [ - -1.044869066002807, - 1.4058936571188063, - 0.5674979032376113 - ], - "translation_norm_m": 0.01841288193193981, - "rotation_rpy_deg_xyz": [ - 1.0176850945359526, - 0.32888439595989233, - 0.3996664359711866 - ], - "rotation_angle_deg": 1.1407186210171152, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008863920037717854, - 0.015030399668509498, - 0.001742505544354192 - ], - "translation_xyz_cm": [ - 0.8863920037717854, - 1.5030399668509498, - 0.1742505544354192 - ], - "translation_norm_m": 0.017536200221321938, - "rotation_rpy_deg_xyz": [ - 0.540071810677193, - 0.986594995524653, - -0.5025310524035612 - ], - "rotation_angle_deg": 1.2337920260254294, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006540851697354633, - 0.040326124921785, - 0.07306370646565859 - ], - "translation_xyz_cm": [ - -0.6540851697354633, - 4.0326124921785, - 7.306370646565859 - ], - "translation_norm_m": 0.08370952332103031, - "rotation_rpy_deg_xyz": [ - -1.302814168669691, - -0.600844507133393, - 0.6105050434568302 - ], - "rotation_angle_deg": 1.556495869523796, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02010133223356725, - 0.025008773241824933, - 0.06014134756967511 - ], - "translation_xyz_cm": [ - 2.010133223356725, - 2.5008773241824933, - 6.014134756967511 - ], - "translation_norm_m": 0.06816512293043807, - "rotation_rpy_deg_xyz": [ - -0.5547609780192527, - -0.3373912978754272, - 0.48915497518335266 - ], - "rotation_angle_deg": 0.8119506258047068, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0055032593079631376, - 0.0002656943957939917, - 0.03494916948632164 - ], - "translation_xyz_cm": [ - -0.5503259307963138, - 0.026569439579399168, - 3.494916948632164 - ], - "translation_norm_m": 0.03538079852556009, - "rotation_rpy_deg_xyz": [ - 0.4127115364150137, - -1.348332990694566, - 0.23240685138234501 - ], - "rotation_angle_deg": 1.4298923818924867, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016884160143425753, - 0.008607552821607689, - 0.03879581418736493 - ], - "translation_xyz_cm": [ - -1.6884160143425753, - 0.8607552821607689, - 3.8795814187364925 - ], - "translation_norm_m": 0.04317730917723057, - "rotation_rpy_deg_xyz": [ - -0.9118064284041235, - -1.3797937097033854, - 0.17136247559601578 - ], - "rotation_angle_deg": 1.6615600301528897, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.005775508477052105, - 0.02076714939687674, - -0.05076414348547613 - ], - "translation_xyz_cm": [ - 0.5775508477052105, - 2.076714939687674, - -5.076414348547613 - ], - "translation_norm_m": 0.05515096786145015, - "rotation_rpy_deg_xyz": [ - -0.5050673809886981, - -0.66026085625198, - 0.08321837418381936 - ], - "rotation_angle_deg": 0.8351499617353654, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006883474554614022, - 0.003970201090887748, - -0.0163538720701132 - ], - "translation_xyz_cm": [ - -0.6883474554614022, - 0.39702010908877483, - -1.6353872070113198 - ], - "translation_norm_m": 0.018182239970139364, - "rotation_rpy_deg_xyz": [ - -0.034951376794299036, - -0.32397088612378405, - -0.05340719174115674 - ], - "rotation_angle_deg": 0.3302144844170468, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008893183134704774, - 0.02383393553519708, - -0.028835517137602337 - ], - "translation_xyz_cm": [ - 0.8893183134704774, - 2.383393553519708, - -2.883551713760234 - ], - "translation_norm_m": 0.03845298737362659, - "rotation_rpy_deg_xyz": [ - 0.7856163908613215, - 0.09621887346271842, - -0.15207965200918738 - ], - "rotation_angle_deg": 0.8060890358556931, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0027345237894904617, - 0.0020992149751937195, - 0.023853082836052163 - ], - "translation_xyz_cm": [ - 0.27345237894904617, - 0.20992149751937195, - 2.3853082836052164 - ], - "translation_norm_m": 0.024100910452738773, - "rotation_rpy_deg_xyz": [ - 1.1521027638005261, - -0.21735787213369703, - 0.017773028427946282 - ], - "rotation_angle_deg": 1.1725942093884534, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.03882152008818496, - "improved_pairs": 14, - "worsened_pairs": 25, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08839405329553651, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152192452926, - 0.0011901746480735614, - 0.7182307404781154 - ], - "rotation_rpy_deg_xyz": [ - -0.886624718165571, - 1.3011901167388817, - -0.8376398312653468 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08013195956996022, - "median": 0.05383973058912754, - "p90": 0.12087983168040736, - "p95": 0.14326099265270584, - "max": 0.23402318641039124 - }, - "rotation_deg": { - "rms": 0.9681458624297539, - "median": 0.8476987946919522, - "p90": 1.4072350234521074, - "p95": 1.540776818931018, - "max": 1.8183433735842316 - }, - "normalized_pair_score": { - "rms": 2.5134991588556583, - "median": 2.350994519137053, - "p90": 3.45304516759142, - "p95": 3.762791608578391, - "max": 4.86507311750119 - }, - "normalized_global_rms": 2.5134991588556583 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02119631155142665, - -0.014978593526507211, - 0.12994451134180063 - ], - "translation_xyz_cm": [ - 2.119631155142665, - -1.4978593526507211, - 12.994451134180062 - ], - "translation_norm_m": 0.13251119920699841, - "rotation_rpy_deg_xyz": [ - -0.2859995191891049, - -0.1560693864068539, - -0.34522485397194785 - ], - "rotation_angle_deg": 0.47497594758710626, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6807154082401394, - "median": 0.7133278004221145, - "p90": 2.3175185373442213, - "p95": 3.9104710727627636, - "max": 5.650741373677544 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02119631155142665, - -0.014978593526507211, - 0.12994451134180063 - ], - "translation_xyz_cm": [ - 2.119631155142665, - -1.4978593526507211, - 12.994451134180062 - ], - "translation_norm_m": 0.13251119920699841, - "rotation_rpy_deg_xyz": [ - -0.2859995191891049, - -0.1560693864068539, - -0.34522485397194785 - ], - "rotation_angle_deg": 0.47497594758710626, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03396818235809751, - 0.00878382019677093, - 0.10607248389310456 - ], - "translation_xyz_cm": [ - 3.396818235809751, - 0.8783820196770931, - 10.607248389310456 - ], - "translation_norm_m": 0.11172450379936845, - "rotation_rpy_deg_xyz": [ - -0.23851028397301854, - -0.20208116029095863, - -0.40071059519729996 - ], - "rotation_angle_deg": 0.508556349911955, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0346510444157363, - -0.01858136528990001, - 0.04667892716842384 - ], - "translation_xyz_cm": [ - 3.46510444157363, - -1.858136528990001, - 4.667892716842384 - ], - "translation_norm_m": 0.06103182986551401, - "rotation_rpy_deg_xyz": [ - 0.2727109329174662, - 0.10412671169097691, - -0.3505805509176563 - ], - "rotation_angle_deg": 0.45639217061688064, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.046599157030482785, - 0.01201418458500203, - 0.02414320862511324 - ], - "translation_xyz_cm": [ - 4.659915703048279, - 1.201418458500203, - 2.4143208625113237 - ], - "translation_norm_m": 0.05383973058912754, - "rotation_rpy_deg_xyz": [ - 0.39468716432557627, - 0.30706777359276505, - -0.38257391851367745 - ], - "rotation_angle_deg": 0.6302692451060993, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00557795419258289, - 0.021039649660189813, - -0.009979750464636731 - ], - "translation_xyz_cm": [ - 0.557795419258289, - 2.103964966018981, - -0.9979750464636731 - ], - "translation_norm_m": 0.02394526780252197, - "rotation_rpy_deg_xyz": [ - 0.27521971511658333, - 0.23577462209218872, - -0.033499231338283295 - ], - "rotation_angle_deg": 0.36399943837705984, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03238153180945386, - 0.0008425068358075549, - -0.07100889648022081 - ], - "translation_xyz_cm": [ - -3.2381531809453863, - 0.08425068358075549, - -7.100889648022081 - ], - "translation_norm_m": 0.07804829786378284, - "rotation_rpy_deg_xyz": [ - 0.5632000694209124, - 0.5518017340856848, - 0.534349401120655 - ], - "rotation_angle_deg": 0.9509487171329924, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03116488362423206, - -0.019801674550828874, - -0.050759817210635216 - ], - "translation_xyz_cm": [ - -3.116488362423206, - -1.9801674550828874, - -5.075981721063521 - ], - "translation_norm_m": 0.06276874484634826, - "rotation_rpy_deg_xyz": [ - 0.4815637922603291, - 0.38094344540770475, - 0.5860479423359293 - ], - "rotation_angle_deg": 0.8476987946919522, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.037904535831685994, - -0.037186128928924866, - -0.07671119042341559 - ], - "translation_xyz_cm": [ - -3.7904535831685995, - -3.7186128928924864, - -7.67111904234156 - ], - "translation_norm_m": 0.09329613474046884, - "rotation_rpy_deg_xyz": [ - 0.6268512424268373, - 0.8211744743409899, - 0.5013861484957061 - ], - "rotation_angle_deg": 1.1463594545058189, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01303056623486741, - -0.010167335537615035, - -0.03059533425779505 - ], - "translation_xyz_cm": [ - -1.3030566234867411, - -1.0167335537615037, - -3.059533425779505 - ], - "translation_norm_m": 0.03477419800199458, - "rotation_rpy_deg_xyz": [ - 0.3305955185099562, - 0.29537346473146064, - -0.08720375254234271 - ], - "rotation_angle_deg": 0.45198641159390757, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008388908460665423, - 0.0161987181174873, - -0.13375575822561867 - ], - "translation_xyz_cm": [ - 0.8388908460665423, - 1.6198718117487299, - -13.375575822561867 - ], - "translation_norm_m": 0.13499398176334154, - "rotation_rpy_deg_xyz": [ - -0.8084908549093847, - 0.7075060940116674, - 0.29111398364103325 - ], - "rotation_angle_deg": 1.1143900724128104, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0016489886371057194, - -0.0015255588491572825, - 0.00094380441010747 - ], - "translation_xyz_cm": [ - 0.16489886371057194, - -0.15255588491572825, - 0.094380441010747 - ], - "translation_norm_m": 0.002436649357639334, - "rotation_rpy_deg_xyz": [ - 0.15950646360005527, - -0.2593050590139673, - -0.4785475246748707 - ], - "rotation_angle_deg": 0.5668713447808463, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010392144236766265, - 0.02069494956350304, - -0.062170518719551204 - ], - "translation_xyz_cm": [ - 1.0392144236766265, - 2.069494956350304, - -6.21705187195512 - ], - "translation_norm_m": 0.06634343220795677, - "rotation_rpy_deg_xyz": [ - 0.07139009081988294, - 0.030521331812318482, - 0.006506800533151232 - ], - "rotation_angle_deg": 0.07791140891886357, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012669544013501066, - 0.04063694607042234, - -0.1100250500824161 - ], - "translation_xyz_cm": [ - 1.2669544013501066, - 4.063694607042234, - -11.00250500824161 - ], - "translation_norm_m": 0.11797198979875954, - "rotation_rpy_deg_xyz": [ - -0.9186666974032417, - -0.1616942211636445, - 0.16718354119765155 - ], - "rotation_angle_deg": 0.9474224225111134, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006854316879474964, - 0.01689591723777073, - -0.052693813537176934 - ], - "translation_xyz_cm": [ - 0.6854316879474964, - 1.689591723777073, - -5.2693813537176935 - ], - "translation_norm_m": 0.05575922940895636, - "rotation_rpy_deg_xyz": [ - -0.9285606542260966, - -0.05706580009457916, - 0.1654061692680799 - ], - "rotation_angle_deg": 0.9448211203286838, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0009616722788510224, - 0.009721971661267315, - 0.014467816743086063 - ], - "translation_xyz_cm": [ - -0.09616722788510224, - 0.9721971661267315, - 1.4467816743086064 - ], - "translation_norm_m": 0.01745735569511937, - "rotation_rpy_deg_xyz": [ - -0.0856155482551795, - 1.752275345633886, - 0.47680561203867805 - ], - "rotation_angle_deg": 1.8183433735842316, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03458806433364725, - -0.0059023003124833995, - 0.23137778725354227 - ], - "translation_xyz_cm": [ - 3.458806433364725, - -0.59023003124834, - 23.137778725354227 - ], - "translation_norm_m": 0.23402318641039124, - "rotation_rpy_deg_xyz": [ - 0.11632479527065477, - -0.28575635982081465, - -0.24968190503423518 - ], - "rotation_angle_deg": 0.39671674463448364, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010728392234058415, - 0.02553457429016559, - 0.21589475092605578 - ], - "translation_xyz_cm": [ - -1.0728392234058415, - 2.553457429016559, - 21.58947509260558 - ], - "translation_norm_m": 0.21766409065698333, - "rotation_rpy_deg_xyz": [ - 0.7671547642076333, - -0.33406861259515797, - -0.6945914859146701 - ], - "rotation_angle_deg": 1.0860333666628483, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0012719835922228029, - -0.0038184019393399105, - -0.04762711490967106 - ], - "translation_xyz_cm": [ - 0.1271983592222803, - -0.38184019393399105, - -4.7627114909671056 - ], - "translation_norm_m": 0.047796864021065755, - "rotation_rpy_deg_xyz": [ - -0.4791155358175677, - 0.6734897035570675, - 0.09116731388147337 - ], - "rotation_angle_deg": 0.8318426576039071, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.00028499373283796814, - 0.027075257313049272, - 0.04138213809453958 - ], - "translation_xyz_cm": [ - 0.028499373283796814, - 2.7075257313049272, - 4.1382138094539584 - ], - "translation_norm_m": 0.049453332883346995, - "rotation_rpy_deg_xyz": [ - -0.8002908277798098, - -0.03949810788863584, - -0.7393322193153724 - ], - "rotation_angle_deg": 1.0904295457926423, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014911928504075966, - -0.04040630111482679, - -0.021235096341533023 - ], - "translation_xyz_cm": [ - 1.4911928504075966, - -4.040630111482679, - -2.123509634153302 - ], - "translation_norm_m": 0.048020454997083434, - "rotation_rpy_deg_xyz": [ - 0.14226381664395268, - 0.14036504556726948, - -0.6442170632022658 - ], - "rotation_angle_deg": 0.6746710734008035, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.007560103514932415, - -0.012267879078138977, - -0.01743280672626174 - ], - "translation_xyz_cm": [ - 0.7560103514932415, - -1.2267879078138977, - -1.743280672626174 - ], - "translation_norm_m": 0.02261766505604701, - "rotation_rpy_deg_xyz": [ - -1.3324594061867159, - -0.969406112328205, - 0.1513634581226307 - ], - "rotation_angle_deg": 1.6536779785483025, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006274040721488072, - 0.00398805620607727, - 0.054993194901440064 - ], - "translation_xyz_cm": [ - 0.6274040721488072, - 0.398805620607727, - 5.499319490144006 - ], - "translation_norm_m": 0.05549342001305646, - "rotation_rpy_deg_xyz": [ - -0.3353379264586897, - -0.26934174279036444, - -0.13710989566871135 - ], - "rotation_angle_deg": 0.45167628467944815, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.009957281734663592, - -0.026867227191390952, - 0.016674434544485764 - ], - "translation_xyz_cm": [ - -0.9957281734663592, - -2.6867227191390954, - 1.6674434544485763 - ], - "translation_norm_m": 0.03315165341088771, - "rotation_rpy_deg_xyz": [ - 0.8796047447628413, - -0.1102874751875873, - -0.20894294784457407 - ], - "rotation_angle_deg": 0.9105877835712745, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011062810520623634, - 0.02138963985908715, - 0.03828193477951412 - ], - "translation_xyz_cm": [ - -1.1062810520623634, - 2.138963985908715, - 3.8281934779514115 - ], - "translation_norm_m": 0.045226198164113274, - "rotation_rpy_deg_xyz": [ - 0.13546007758816025, - 1.1738775899501497, - -0.2806225764297054 - ], - "rotation_angle_deg": 1.2148507894592246, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008613487472253212, - -0.02902210596729271, - -0.06333958372220654 - ], - "translation_xyz_cm": [ - 0.08613487472253212, - -2.902210596729271, - -6.333958372220653 - ], - "translation_norm_m": 0.06967730923725116, - "rotation_rpy_deg_xyz": [ - 0.48903453000759556, - 0.35890162149795, - -0.08451716738429373 - ], - "rotation_angle_deg": 0.6126714873540658, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019140372854559606, - 0.019356740725566146, - -0.046509280918771025 - ], - "translation_xyz_cm": [ - -1.9140372854559606, - 1.9356740725566146, - -4.650928091877103 - ], - "translation_norm_m": 0.05389017068176266, - "rotation_rpy_deg_xyz": [ - 0.007998251057806688, - 0.1066305149103925, - 0.07351328630616319 - ], - "rotation_angle_deg": 0.12975802922554627, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03232521419054146, - 0.024116034344768278, - -0.07391446099707295 - ], - "translation_xyz_cm": [ - -3.2325214190541463, - 2.411603434476828, - -7.391446099707295 - ], - "translation_norm_m": 0.08420124779045882, - "rotation_rpy_deg_xyz": [ - 0.22318467717621293, - 0.721922258399074, - 0.32051382944258944 - ], - "rotation_angle_deg": 0.8202492269463538, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008953804777239949, - 0.01360376470860758, - -0.03569696328026602 - ], - "translation_xyz_cm": [ - -0.8953804777239949, - 1.360376470860758, - -3.569696328026602 - ], - "translation_norm_m": 0.03923654191781868, - "rotation_rpy_deg_xyz": [ - 0.41489304741094685, - 0.6825534207726283, - 0.24871669863710305 - ], - "rotation_angle_deg": 0.8358487180140904, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007870624205977617, - 0.002144076896329228, - 0.05040281036765824 - ], - "translation_xyz_cm": [ - 0.7870624205977617, - 0.21440768963292278, - 5.040281036765824 - ], - "translation_norm_m": 0.05105866316392558, - "rotation_rpy_deg_xyz": [ - 1.272747216860497, - -0.13188145790893532, - -0.27776221463561995 - ], - "rotation_angle_deg": 1.3090501901544653, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011194570926770453, - 0.011583514105244053, - 0.010653817949428143 - ], - "translation_xyz_cm": [ - -1.1194570926770453, - 1.1583514105244053, - 1.0653817949428144 - ], - "translation_norm_m": 0.019313209317988543, - "rotation_rpy_deg_xyz": [ - 1.2010993705423756, - 0.27514912949213594, - 0.40191287864508757 - ], - "rotation_angle_deg": 1.2952040285997868, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008065753351425009, - 0.012571376328001094, - 0.006932519478819718 - ], - "translation_xyz_cm": [ - 0.8065753351425009, - 1.2571376328001094, - 0.6932519478819719 - ], - "translation_norm_m": 0.016466806193991136, - "rotation_rpy_deg_xyz": [ - 0.7217956486836289, - 0.9303576135000602, - -0.4999437774749251 - ], - "rotation_angle_deg": 1.2815370898367058, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0057233637376201685, - 0.04021721389432631, - 0.06780244443790286 - ], - "translation_xyz_cm": [ - -0.5723363737620168, - 4.021721389432631, - 6.780244443790286 - ], - "translation_norm_m": 0.07904019646768347, - "rotation_rpy_deg_xyz": [ - -1.2907472905985025, - -0.5517341215701028, - 0.6104702705434002 - ], - "rotation_angle_deg": 1.5282322456402084, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021631650330897756, - 0.024223110657609404, - 0.051484301851855055 - ], - "translation_xyz_cm": [ - 2.1631650330897756, - 2.4223110657609404, - 5.148430185185505 - ], - "translation_norm_m": 0.06087134566560809, - "rotation_rpy_deg_xyz": [ - -0.4835581729566882, - -0.2401659010034725, - 0.49148012414418346 - ], - "rotation_angle_deg": 0.7294261829939989, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004587380603610747, - 7.886690298652965e-05, - 0.03217901899295324 - ], - "translation_xyz_cm": [ - -0.4587380603610747, - 0.007886690298652965, - 3.217901899295324 - ], - "translation_norm_m": 0.03250445421999293, - "rotation_rpy_deg_xyz": [ - 0.43361093468588424, - -1.2856382988989365, - 0.23437117461102247 - ], - "rotation_angle_deg": 1.377709699166698, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015418282185852394, - 0.007415408509479693, - 0.03422610211692746 - ], - "translation_xyz_cm": [ - -1.5418282185852394, - 0.7415408509479693, - 3.422610211692746 - ], - "translation_norm_m": 0.03826405330128244, - "rotation_rpy_deg_xyz": [ - -0.8156949715073674, - -1.278405187244089, - 0.17367512865310875 - ], - "rotation_angle_deg": 1.5253363205937427, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.006834019629686883, - 0.01892379575102332, - -0.05033551888354166 - ], - "translation_xyz_cm": [ - 0.6834019629686883, - 1.892379575102332, - -5.033551888354166 - ], - "translation_norm_m": 0.05420773313099131, - "rotation_rpy_deg_xyz": [ - -0.3566702148265097, - -0.5713740619511016, - 0.08737319383542423 - ], - "rotation_angle_deg": 0.6789728425166692, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005863634973002352, - 0.0035619305910778998, - -0.018952262797933737 - ], - "translation_xyz_cm": [ - -0.5863634973002352, - 0.35619305910779, - -1.8952262797933737 - ], - "translation_norm_m": 0.020155838603099996, - "rotation_rpy_deg_xyz": [ - -0.00031499297290635736, - -0.2468232074603096, - -0.05138302906035575 - ], - "rotation_angle_deg": 0.25211520437696516, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01005047911072432, - 0.022713793358650536, - -0.027032834504322673 - ], - "translation_xyz_cm": [ - 1.005047911072432, - 2.2713793358650536, - -2.7032834504322674 - ], - "translation_norm_m": 0.036711070270869, - "rotation_rpy_deg_xyz": [ - 0.8689029352651022, - 0.19617358650815822, - -0.14711017514853503 - ], - "rotation_angle_deg": 0.9030804350118543, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003298723518240898, - 0.0020250006385073016, - 0.023284416689010823 - ], - "translation_xyz_cm": [ - 0.3298723518240898, - 0.20250006385073016, - 2.3284416689010823 - ], - "translation_norm_m": 0.02360394596213176, - "rotation_rpy_deg_xyz": [ - 1.161154845754953, - -0.17431366298870507, - 0.019552097048139885 - ], - "rotation_angle_deg": 1.174357752359419, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.014357823178714035, - "improved_pairs": 17, - "worsened_pairs": 22, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.040343980923164935, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152188350905, - -0.00132483596826191, - 0.7182305054498935 - ], - "rotation_rpy_deg_xyz": [ - -0.6865945926762015, - 1.304106599014521, - -0.8334414989727543 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07873808044179886, - "median": 0.05030560487239743, - "p90": 0.11866135486190646, - "p95": 0.1421067682284573, - "max": 0.2301662337663633 - }, - "rotation_deg": { - "rms": 0.9850410981186302, - "median": 0.824088246842196, - "p90": 1.5056894881652623, - "p95": 1.6318975802726772, - "max": 1.6930747226172207 - }, - "normalized_pair_score": { - "rms": 2.5221217227950565, - "median": 2.3578793450726656, - "p90": 3.404241667335655, - "p95": 3.552063672979961, - "max": 4.953180425594745 - }, - "normalized_global_rms": 2.5221217227950565 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.019842367959444496, - -0.014866617413089145, - 0.1316251986695021 - ], - "translation_xyz_cm": [ - 1.9842367959444496, - -1.4866617413089145, - 13.162519866950209 - ], - "translation_norm_m": 0.13394001942784334, - "rotation_rpy_deg_xyz": [ - -0.2640015191939441, - -0.2443926360888103, - -0.3455133188999571 - ], - "rotation_angle_deg": 0.4991919434350986, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6476453039285432, - "median": 0.7594633089830762, - "p90": 2.329487946106142, - "p95": 3.8537501645923045, - "max": 5.457199431160461 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.0059241016060888885, - "p90": 0.053409267341990724, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.019842367959444496, - -0.014866617413089145, - 0.1316251986695021 - ], - "translation_xyz_cm": [ - 1.9842367959444496, - -1.4866617413089145, - 13.162519866950209 - ], - "translation_norm_m": 0.13394001942784334, - "rotation_rpy_deg_xyz": [ - -0.2640015191939441, - -0.2443926360888103, - -0.3455133188999571 - ], - "rotation_angle_deg": 0.4991919434350986, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.031933271891301906, - 0.008452300672117552, - 0.10827736429768191 - ], - "translation_xyz_cm": [ - 3.1933271891301906, - 0.8452300672117552, - 10.82773642976819 - ], - "translation_norm_m": 0.1132040761615438, - "rotation_rpy_deg_xyz": [ - -0.18581872088047238, - -0.3344855949792437, - -0.40083989933243136 - ], - "rotation_angle_deg": 0.5545412208792635, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03402353510023726, - -0.018502229709528584, - 0.047571348502387874 - ], - "translation_xyz_cm": [ - 3.4023535100237257, - -1.8502229709528584, - 4.757134850238788 - ], - "translation_norm_m": 0.06134302440601441, - "rotation_rpy_deg_xyz": [ - 0.27858037335093544, - 0.058855562691976955, - -0.351286454619393 - ], - "rotation_angle_deg": 0.45229795458630645, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0452843945554362, - 0.01183021382921745, - 0.025673599860923067 - ], - "translation_xyz_cm": [ - 4.52843945554362, - 1.183021382921745, - 2.5673599860923066 - ], - "translation_norm_m": 0.05338318161477655, - "rotation_rpy_deg_xyz": [ - 0.42037335763404376, - 0.21187738375171225, - -0.38397378613114397 - ], - "rotation_angle_deg": 0.6079782227248322, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.004893346276888763, - 0.020940819214246148, - -0.009270416577605835 - ], - "translation_xyz_cm": [ - 0.48933462768887626, - 2.094081921424615, - -0.9270416577605834 - ], - "translation_norm_m": 0.023418013807144936, - "rotation_rpy_deg_xyz": [ - 0.2832035718683816, - 0.18266221061755814, - -0.03430570568825576 - ], - "rotation_angle_deg": 0.33878832622757693, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.034051428336521306, - -3.0194447016740344e-05, - -0.0701874735568548 - ], - "translation_xyz_cm": [ - -3.4051428336521306, - -0.0030194447016740344, - -7.01874735568548 - ], - "translation_norm_m": 0.07801142305942167, - "rotation_rpy_deg_xyz": [ - 0.6228614425523304, - 0.4121775244591239, - 0.5323440753923214 - ], - "rotation_angle_deg": 0.9158853109582283, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.032317051549761416, - -0.020278343682710004, - -0.05044676905918737 - ], - "translation_xyz_cm": [ - -3.2317051549761415, - -2.0278343682710003, - -5.044676905918737 - ], - "translation_norm_m": 0.06324934428035618, - "rotation_rpy_deg_xyz": [ - 0.5083624656871717, - 0.2837996282875649, - 0.5844844192085773 - ], - "rotation_angle_deg": 0.824088246842196, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03960599232255134, - -0.03819349402507172, - -0.07575201486596278 - ], - "translation_xyz_cm": [ - -3.960599232255134, - -3.8193494025071715, - -7.575201486596278 - ], - "translation_norm_m": 0.09362555938391091, - "rotation_rpy_deg_xyz": [ - 0.6939128257794969, - 0.6746161975739622, - 0.49920995653775374 - ], - "rotation_angle_deg": 1.087079763231695, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013817621632674283, - -0.010366958639124929, - -0.02979813970936399 - ], - "translation_xyz_cm": [ - -1.3817621632674284, - -1.036695863912493, - -2.979813970936399 - ], - "translation_norm_m": 0.03444313616887769, - "rotation_rpy_deg_xyz": [ - 0.34166753559265733, - 0.23259292708536114, - -0.08818221586065197 - ], - "rotation_angle_deg": 0.42276990528599845, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.007550045605277944, - 0.015536496721341275, - -0.13284431943565833 - ], - "translation_xyz_cm": [ - 0.7550045605277944, - 1.5536496721341275, - -13.284431943565833 - ], - "translation_norm_m": 0.13396267810602047, - "rotation_rpy_deg_xyz": [ - -0.7895954188094686, - 0.6255185088090308, - 0.2915613590483623 - ], - "rotation_angle_deg": 1.0498796689466594, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -9.965853382298828e-05, - -0.0022221435788458144, - 0.0032574646187508785 - ], - "translation_xyz_cm": [ - -0.009965853382298828, - -0.22221435788458144, - 0.3257464618750878 - ], - "translation_norm_m": 0.003944480910181115, - "rotation_rpy_deg_xyz": [ - 0.2131919550411292, - -0.39277401331860123, - -0.47959342157059537 - ], - "rotation_angle_deg": 0.6550036855480482, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009841658174921719, - 0.020368149073090702, - -0.06075354099602698 - ], - "translation_xyz_cm": [ - 0.9841658174921719, - 2.03681490730907, - -6.075354099602698 - ], - "translation_norm_m": 0.06482833081185709, - "rotation_rpy_deg_xyz": [ - 0.07744588481441383, - -0.015492961591267335, - 0.005952978997094564 - ], - "rotation_angle_deg": 0.0792051735389124, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011587326184248181, - 0.03992182974893721, - -0.1070541678289783 - ], - "translation_xyz_cm": [ - 1.1587326184248181, - 3.992182974893721, - -10.70541678289783 - ], - "translation_norm_m": 0.11484168872042218, - "rotation_rpy_deg_xyz": [ - -0.8914459256017848, - -0.25956390632414356, - 0.16800492664726585 - ], - "rotation_angle_deg": 0.9431831507113868, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006171727372332958, - 0.016599561665977647, - -0.0506658525881516 - ], - "translation_xyz_cm": [ - 0.6171727372332958, - 1.6599561665977647, - -5.06658525881516 - ], - "translation_norm_m": 0.05367182021084534, - "rotation_rpy_deg_xyz": [ - -0.9199126793112754, - -0.11240312769235343, - 0.1657357544157429 - ], - "rotation_angle_deg": 0.9412981298122861, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0035179195826497978, - 0.006785560659960055, - 0.019411094478540097 - ], - "translation_xyz_cm": [ - -0.3517919582649798, - 0.6785560659960055, - 1.9411094478540096 - ], - "translation_norm_m": 0.020861691698297106, - "rotation_rpy_deg_xyz": [ - 0.13982392787711678, - 1.5567651178246398, - 0.47915510705051045 - ], - "rotation_angle_deg": 1.6342650258778777, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03158579660946648, - -0.009548356701029714, - 0.22778863339299332 - ], - "translation_xyz_cm": [ - 3.1585796609466477, - -0.9548356701029714, - 22.77886333929933 - ], - "translation_norm_m": 0.2301662337663633, - "rotation_rpy_deg_xyz": [ - 0.3880015617715102, - -0.46959375266784853, - -0.24683597011303493 - ], - "rotation_angle_deg": 0.6566621160934105, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013709756778841342, - 0.024825280247476655, - 0.21352856955930252 - ], - "translation_xyz_cm": [ - -1.3709756778841342, - 2.4825280247476655, - 21.352856955930253 - ], - "translation_norm_m": 0.21540357933038773, - "rotation_rpy_deg_xyz": [ - 0.8700771598850835, - -0.506026291618741, - -0.6970695574621423 - ], - "rotation_angle_deg": 1.2221411061286953, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0004948746440140428, - -0.004667652754462015, - -0.042119423071664754 - ], - "translation_xyz_cm": [ - -0.04948746440140428, - -0.4667652754462015, - -4.211942307166475 - ], - "translation_norm_m": 0.042380156713247415, - "rotation_rpy_deg_xyz": [ - -0.4184808869362607, - 0.5329224436981862, - 0.0917172513454058 - ], - "rotation_angle_deg": 0.684032365585507, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0011130991187053851, - 0.026653758424031393, - 0.0405893338457303 - ], - "translation_xyz_cm": [ - -0.11130991187053851, - 2.6653758424031393, - 4.05893338457303 - ], - "translation_norm_m": 0.04857114215061073, - "rotation_rpy_deg_xyz": [ - -0.7643956663987446, - -0.15094974681174766, - -0.7385242507520419 - ], - "rotation_angle_deg": 1.0742360850849277, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012807394822990759, - -0.041534070753315167, - -0.011285466984450154 - ], - "translation_xyz_cm": [ - 1.2807394822990759, - -4.153407075331517, - -1.1285466984450154 - ], - "translation_norm_m": 0.0449051239899243, - "rotation_rpy_deg_xyz": [ - 0.21832176956990013, - -0.013724806516689385, - -0.6450878905659495 - ], - "rotation_angle_deg": 0.6811438245697251, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.005983894556965019, - -0.012592910003347446, - -0.011290312074711512 - ], - "translation_xyz_cm": [ - 0.5983894556965019, - -1.2592910003347446, - -1.1290312074711513 - ], - "translation_norm_m": 0.017940443783966444, - "rotation_rpy_deg_xyz": [ - -1.3006641369602876, - -1.0747709400033723, - 0.15306204509024643 - ], - "rotation_angle_deg": 1.6930747226172207, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.003482734365272133, - 0.0021124671677758416, - 0.059658142631649015 - ], - "translation_xyz_cm": [ - 0.3482734365272133, - 0.21124671677758416, - 5.965814263164901 - ], - "translation_norm_m": 0.05979703954588518, - "rotation_rpy_deg_xyz": [ - -0.1836152884096103, - -0.4605521882433464, - -0.1354186107262789 - ], - "rotation_angle_deg": 0.5141601544920775, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.010672009963219153, - -0.03209390774647375, - 0.020673276042493707 - ], - "translation_xyz_cm": [ - -1.0672009963219153, - -3.2093907746473747, - 2.0673276042493707 - ], - "translation_norm_m": 0.03963956424361097, - "rotation_rpy_deg_xyz": [ - 1.2739169133989858, - -0.15441412885717196, - -0.2014069531115573 - ], - "rotation_angle_deg": 1.2986834208932883, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012954721643003264, - 0.02078865823610565, - 0.04296889640638764 - ], - "translation_xyz_cm": [ - -1.2954721643003264, - 2.078865823610565, - 4.2968896406387636 - ], - "translation_norm_m": 0.04946027883552794, - "rotation_rpy_deg_xyz": [ - 0.191791910955383, - 1.037596898585814, - -0.2816015854053235 - ], - "rotation_angle_deg": 1.0925501090259304, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0017320874770283545, - -0.0318405703494562, - -0.05194203272838931 - ], - "translation_xyz_cm": [ - -0.17320874770283545, - -3.18405703494562, - -5.194203272838931 - ], - "translation_norm_m": 0.06094913298123128, - "rotation_rpy_deg_xyz": [ - 0.6933490618424856, - 0.1618118341226918, - -0.08461018679361057 - ], - "rotation_angle_deg": 0.7171053899483946, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0213520973639163, - 0.0176725688918955, - -0.04235472267841239 - ], - "translation_xyz_cm": [ - -2.13520973639163, - 1.7672568891895502, - -4.2354722678412395 - ], - "translation_norm_m": 0.05061772699600581, - "rotation_rpy_deg_xyz": [ - 0.13180225970325057, - -0.07541314713550007, - 0.07360727442891095 - ], - "rotation_angle_deg": 0.16878913744897628, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.034560413559181935, - 0.021197905163034325, - -0.07151105424639809 - ], - "translation_xyz_cm": [ - -3.4560413559181935, - 2.1197905163034325, - -7.151105424639809 - ], - "translation_norm_m": 0.08220464857971217, - "rotation_rpy_deg_xyz": [ - 0.4535735237818598, - 0.5271060340707374, - 0.32192781941085574 - ], - "rotation_angle_deg": 0.7654156935582683, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010243661748970012, - 0.013129261440568252, - -0.03345153435302803 - ], - "translation_xyz_cm": [ - -1.0243661748970012, - 1.3129261440568252, - -3.345153435302803 - ], - "translation_norm_m": 0.03736730205104348, - "rotation_rpy_deg_xyz": [ - 0.44518602143587854, - 0.5795776437935242, - 0.24721901257678483 - ], - "rotation_angle_deg": 0.7707802929569919, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.005718154223623317, - -0.0017491995202032484, - 0.04994894288061716 - ], - "translation_xyz_cm": [ - 0.5718154223623317, - -0.17491995202032484, - 4.994894288061716 - ], - "translation_norm_m": 0.05030560487239743, - "rotation_rpy_deg_xyz": [ - 1.5809314832406116, - -0.29726000660992996, - -0.27714107576104496 - ], - "rotation_angle_deg": 1.6316345307609883, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.012700360892276219, - 0.006611294775778154, - 0.020586448539499147 - ], - "translation_xyz_cm": [ - -1.270036089227622, - 0.6611294775778154, - 2.0586448539499145 - ], - "translation_norm_m": 0.025076089186229524, - "rotation_rpy_deg_xyz": [ - 1.5679145729741613, - 0.16764841017804855, - 0.4061841976724548 - ], - "rotation_angle_deg": 1.6277506145260534, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.006453544999329264, - 0.007631657257044955, - 0.017287709076919233 - ], - "translation_xyz_cm": [ - 0.6453544999329264, - 0.7631657257044955, - 1.7287709076919233 - ], - "translation_norm_m": 0.019968858772487986, - "rotation_rpy_deg_xyz": [ - 1.0852257905014293, - 0.8178517107316483, - -0.494996816289085 - ], - "rotation_angle_deg": 1.4488804877580408, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0041012404220150955, - 0.03997490777605517, - 0.0572776244940139 - ], - "translation_xyz_cm": [ - -0.41012404220150955, - 3.997490777605517, - 5.72776244940139 - ], - "translation_norm_m": 0.06996813340643401, - "rotation_rpy_deg_xyz": [ - -1.266606310436814, - -0.45351511621775104, - 0.6101756290213036 - ], - "rotation_angle_deg": 1.475174206575064, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024649105865161225, - 0.022638411081818077, - 0.03415905684692201 - ], - "translation_xyz_cm": [ - 2.4649105865161225, - 2.2638411081818077, - 3.415905684692201 - ], - "translation_norm_m": 0.04782172352532433, - "rotation_rpy_deg_xyz": [ - -0.34112986197911416, - -0.04571952165030793, - 0.4959893738590014 - ], - "rotation_angle_deg": 0.6035971825803282, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0027644190789093415, - -0.00030635002974560566, - 0.02663515331165689 - ], - "translation_xyz_cm": [ - -0.27644190789093415, - -0.030635002974560566, - 2.663515331165689 - ], - "translation_norm_m": 0.026779978624338556, - "rotation_rpy_deg_xyz": [ - 0.47542849183877006, - -1.1602434177876486, - 0.23804162607315923 - ], - "rotation_angle_deg": 1.2771619340055451, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.012510152338940372, - 0.005030148000313817, - 0.025072876095915256 - ], - "translation_xyz_cm": [ - -1.2510152338940372, - 0.5030148000313817, - 2.5072876095915255 - ], - "translation_norm_m": 0.02846849866378055, - "rotation_rpy_deg_xyz": [ - -0.6234485484604054, - -1.0756382447524488, - 0.1782870731150942 - ], - "rotation_angle_deg": 1.255138487977452, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008953552534015308, - 0.015236244061915594, - -0.04949764282183929 - ], - "translation_xyz_cm": [ - 0.8953552534015308, - 1.5236244061915594, - -4.94976428218393 - ], - "translation_norm_m": 0.0525578336788343, - "rotation_rpy_deg_xyz": [ - -0.05984897349848199, - -0.3936275826445443, - 0.09591926850075025 - ], - "rotation_angle_deg": 0.4094943094169885, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.003834211882641103, - 0.0027365181629508406, - -0.024154030829628463 - ], - "translation_xyz_cm": [ - -0.3834211882641103, - 0.27365181629508406, - -2.4154030829628463 - ], - "translation_norm_m": 0.024609082017332307, - "rotation_rpy_deg_xyz": [ - 0.06897507897604013, - -0.0925250187027215, - -0.047596027899326085 - ], - "rotation_angle_deg": 0.12481393820061966, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012374642815450976, - 0.020475395873511326, - -0.023438071298638907 - ], - "translation_xyz_cm": [ - 1.2374642815450976, - 2.0475395873511326, - -2.3438071298638907 - ], - "translation_norm_m": 0.03349204095284547, - "rotation_rpy_deg_xyz": [ - 1.035512430453766, - 0.39607799703816704, - -0.137252278260299 - ], - "rotation_angle_deg": 1.1175775606990446, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004425899201898398, - 0.0018738645585085756, - 0.02214557488886174 - ], - "translation_xyz_cm": [ - 0.4425899201898398, - 0.18738645585085756, - 2.214557488886174 - ], - "translation_norm_m": 0.0226611217570354, - "rotation_rpy_deg_xyz": [ - 1.179268176108766, - -0.08821806459370339, - 0.022905972350413053 - ], - "rotation_angle_deg": 1.182802535932146, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.022980387118112233, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0017833859279048347, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.300266778135581, - 0.0024476764333135033, - 0.7159592638351174 - ], - "rotation_rpy_deg_xyz": [ - -0.9881056123574021, - 1.3997156446701597, - -0.8397697014302278 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08079188106279227, - "median": 0.05425618808821671, - "p90": 0.12290597764955652, - "p95": 0.145684703821953, - "max": 0.2350677272293833 - }, - "rotation_deg": { - "rms": 0.9976230703529106, - "median": 0.8983672990723964, - "p90": 1.440475794301185, - "p95": 1.597797608038494, - "max": 2.0233381391978384 - }, - "normalized_pair_score": { - "rms": 2.567477045713792, - "median": 2.2994751124529063, - "p90": 3.5848636561003135, - "p95": 4.122659154903877, - "max": 4.747492317535397 - }, - "normalized_global_rms": 2.567477045713792 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021862949978100232, - -0.015659998822578736, - 0.12684165025370076 - ], - "translation_xyz_cm": [ - 2.1862949978100232, - -1.5659998822578736, - 12.684165025370076 - ], - "translation_norm_m": 0.12966120616418092, - "rotation_rpy_deg_xyz": [ - -0.2528550550344141, - -0.10091798351668403, - -0.3438003995990869 - ], - "rotation_angle_deg": 0.43871598020210434, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7067898021773054, - "median": 0.7385055841034844, - "p90": 2.354962484664117, - "p95": 3.858143262184229, - "max": 5.772844678665988 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337456, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021862949978100232, - -0.015659998822578736, - 0.12684165025370076 - ], - "translation_xyz_cm": [ - 2.1862949978100232, - -1.5659998822578736, - 12.684165025370076 - ], - "translation_norm_m": 0.12966120616418092, - "rotation_rpy_deg_xyz": [ - -0.2528550550344141, - -0.10091798351668403, - -0.3438003995990869 - ], - "rotation_angle_deg": 0.43871598020210434, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.035199996019546154, - 0.007997330344484688, - 0.10244616932184443 - ], - "translation_xyz_cm": [ - 3.5199996019546154, - 0.7997330344484688, - 10.244616932184442 - ], - "translation_norm_m": 0.10861958672879814, - "rotation_rpy_deg_xyz": [ - -0.19868474717859064, - -0.10954627505429712, - -0.3986106266322779 - ], - "rotation_angle_deg": 0.45882202317192805, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03494180931670199, - -0.018895917393885353, - 0.04495947950334158 - ], - "translation_xyz_cm": [ - 3.494180931670199, - -1.8895917393885353, - 4.495947950334158 - ], - "translation_norm_m": 0.059994504162403844, - "rotation_rpy_deg_xyz": [ - 0.2924084008623983, - 0.12968628982453115, - -0.34957185078247316 - ], - "rotation_angle_deg": 0.47408089673947634, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04735477326402682, - 0.011500591584786668, - 0.021906116918553833 - ], - "translation_xyz_cm": [ - 4.735477326402682, - 1.1500591584786668, - 2.1906116918553833 - ], - "translation_norm_m": 0.053428607656730166, - "rotation_rpy_deg_xyz": [ - 0.4294373434022533, - 0.36748260964463253, - -0.38033160599565324 - ], - "rotation_angle_deg": 0.6820247645837519, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.005964702932977736, - 0.02075799884975424, - -0.010453518345841488 - ], - "translation_xyz_cm": [ - 0.5964702932977737, - 2.075799884975424, - -1.0453518345841488 - ], - "translation_norm_m": 0.02399475449201171, - "rotation_rpy_deg_xyz": [ - 0.29778168470421745, - 0.26631104314602005, - -0.032314968504418444 - ], - "rotation_angle_deg": 0.40085449181485494, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03111689961543687, - 0.0004674914658625018, - -0.0719365739673613 - ], - "translation_xyz_cm": [ - -3.111689961543687, - 0.04674914658625018, - -7.19365739673613 - ], - "translation_norm_m": 0.07837952962419124, - "rotation_rpy_deg_xyz": [ - 0.6031904858690685, - 0.651406611542103, - 0.5379357967197737 - ], - "rotation_angle_deg": 1.0362651683815214, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030349949538715018, - -0.020124665322709068, - -0.05128063114399952 - ], - "translation_xyz_cm": [ - -3.034994953871502, - -2.0124665322709068, - -5.128063114399952 - ], - "translation_norm_m": 0.06289534737864583, - "rotation_rpy_deg_xyz": [ - 0.5167377508331105, - 0.44288964255019486, - 0.588430494533235 - ], - "rotation_angle_deg": 0.8983672990723964, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03656102961034887, - -0.03750741780060207, - -0.07781152319335848 - ], - "translation_xyz_cm": [ - -3.656102961034887, - -3.750741780060207, - -7.781152319335847 - ], - "translation_norm_m": 0.09379844571158039, - "rotation_rpy_deg_xyz": [ - 0.6666234672158453, - 0.9279467816454481, - 0.5052759287908468 - ], - "rotation_angle_deg": 1.2471176687712298, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012544601411036575, - -0.010450218229439506, - -0.03105555497517807 - ], - "translation_xyz_cm": [ - -1.2544601411036576, - -1.0450218229439505, - -3.105555497517807 - ], - "translation_norm_m": 0.03508591712384041, - "rotation_rpy_deg_xyz": [ - 0.3564483591463069, - 0.3322855184981405, - -0.08576897185896296 - ], - "rotation_angle_deg": 0.4949770877737651, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.00916431181933186, - 0.016125859418411936, - -0.1371060834485559 - ], - "translation_xyz_cm": [ - 0.9164311819331861, - 1.6125859418411936, - -13.71060834485559 - ], - "translation_norm_m": 0.13835500016879299, - "rotation_rpy_deg_xyz": [ - -0.7769448904358175, - 0.7579471378712342, - 0.29198480762629975 - ], - "rotation_angle_deg": 1.1253319541436468, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.002833941324650091, - -0.0020249479444029994, - 0.00040197427464842145 - ], - "translation_xyz_cm": [ - 0.2833941324650091, - -0.20249479444029994, - 0.040197427464842145 - ], - "translation_norm_m": 0.003506168981464038, - "rotation_rpy_deg_xyz": [ - 0.1993671718848384, - -0.16575859100859433, - -0.4757837756391457 - ], - "rotation_angle_deg": 0.5415889089345158, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010836576438109091, - 0.020615843004303414, - -0.06368435808527625 - ], - "translation_xyz_cm": [ - 1.0836576438109091, - 2.0615843004303414, - -6.368435808527625 - ], - "translation_norm_m": 0.0678095998838716, - "rotation_rpy_deg_xyz": [ - 0.09136385549102051, - 0.05654733688530006, - 0.00744052570261287 - ], - "rotation_angle_deg": 0.10770164907213244, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013615875090007279, - 0.040497966763347826, - -0.11343775854036052 - ], - "translation_xyz_cm": [ - 1.361587509000728, - 4.049796676334783, - -11.343775854036052 - ], - "translation_norm_m": 0.12121717052090039, - "rotation_rpy_deg_xyz": [ - -0.8833616580960963, - -0.09914187618707282, - 0.16805556405236433 - ], - "rotation_angle_deg": 0.9045120035676598, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00736619482979145, - 0.016730638992471736, - -0.05462504259441803 - ], - "translation_xyz_cm": [ - 0.736619482979145, - 1.6730638992471736, - -5.462504259441802 - ], - "translation_norm_m": 0.05760269425824495, - "rotation_rpy_deg_xyz": [ - -0.9052256170745232, - -0.025070423963748766, - 0.16596771581643197 - ], - "rotation_angle_deg": 0.9206198464696631, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.001705204179272668, - 0.009949490298470698, - 0.008276952221896656 - ], - "translation_xyz_cm": [ - 0.1705204179272668, - 0.9949490298470698, - 0.8276952221896656 - ], - "translation_norm_m": 0.013054042154671154, - "rotation_rpy_deg_xyz": [ - -0.10051978792551795, - 1.9627003542472232, - 0.4795545560026394 - ], - "rotation_angle_deg": 2.0233381391978384, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.037970835799887914, - -0.005605743167969468, - 0.23191297431791189 - ], - "translation_xyz_cm": [ - 3.7970835799887914, - -0.5605743167969468, - 23.191297431791188 - ], - "translation_norm_m": 0.2350677272293833, - "rotation_rpy_deg_xyz": [ - 0.07231067521941315, - -0.05801636497751822, - -0.2466182566247777 - ], - "rotation_angle_deg": 0.26343353189672236, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.008663982150276528, - 0.024569060725551317, - 0.2100425702275327 - ], - "translation_xyz_cm": [ - -0.8663982150276528, - 2.4569060725551317, - 21.00425702275327 - ], - "translation_norm_m": 0.21165203670039215, - "rotation_rpy_deg_xyz": [ - 0.801629370721204, - -0.19670806726649093, - -0.689648844816506 - ], - "rotation_angle_deg": 1.0747150144675521, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0025974883323312548, - -0.004205998563290514, - -0.054489048274145704 - ], - "translation_xyz_cm": [ - 0.2597488332331255, - -0.4205998563290514, - -5.44890482741457 - ], - "translation_norm_m": 0.054712829860766476, - "rotation_rpy_deg_xyz": [ - -0.43915097058719127, - 0.7740835159489979, - 0.09294873767310093 - ], - "rotation_angle_deg": 0.8951238440139575, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0013283761402047567, - 0.02659392110655978, - 0.03558707577539302 - ], - "translation_xyz_cm": [ - 0.13283761402047567, - 2.659392110655978, - 3.5587075775393022 - ], - "translation_norm_m": 0.044445935531107414, - "rotation_rpy_deg_xyz": [ - -0.7625324033102833, - 0.03417989091551074, - -0.7382415459473038 - ], - "rotation_angle_deg": 1.0617347196043798, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.016426635522518218, - -0.04079104763334751, - -0.025519128954318883 - ], - "translation_xyz_cm": [ - 1.6426635522518218, - -4.079104763334751, - -2.5519128954318884 - ], - "translation_norm_m": 0.050842598912750704, - "rotation_rpy_deg_xyz": [ - 0.1812596701200449, - 0.2554088986144745, - -0.641090634806169 - ], - "rotation_angle_deg": 0.71386476508844, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.008293949369789111, - -0.012720082191929216, - -0.014112513574001923 - ], - "translation_xyz_cm": [ - 0.8293949369789111, - -1.2720082191929216, - -1.4112513574001921 - ], - "translation_norm_m": 0.02073048784989028, - "rotation_rpy_deg_xyz": [ - -1.295708943900491, - -0.9007950249064871, - 0.15177893077110574 - ], - "rotation_angle_deg": 1.5843617871391884, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008559326899485686, - 0.0035978233708111734, - 0.053455846601509684 - ], - "translation_xyz_cm": [ - 0.8559326899485686, - 0.35978233708111734, - 5.345584660150968 - ], - "translation_norm_m": 0.05425618808821671, - "rotation_rpy_deg_xyz": [ - -0.3156527658077964, - -0.09787576634239992, - -0.13481444661203612 - ], - "rotation_angle_deg": 0.3570208517689108, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00693339148927663, - -0.024409562400083018, - 0.0094761809563456 - ], - "translation_xyz_cm": [ - -0.693339148927663, - -2.440956240008302, - 0.9476180956345601 - ], - "translation_norm_m": 0.027086835540987935, - "rotation_rpy_deg_xyz": [ - 0.7043549696279223, - 0.10887282353005566, - -0.20645933279677145 - ], - "rotation_angle_deg": 0.7422063721688006, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0098558600400529, - 0.020852900464370272, - 0.03079341392944729 - ], - "translation_xyz_cm": [ - -0.98558600400529, - 2.085290046437027, - 3.0793413929447286 - ], - "translation_norm_m": 0.03847357244052499, - "rotation_rpy_deg_xyz": [ - 0.17545956036406737, - 1.2701659736097213, - -0.2778434467863792 - ], - "rotation_angle_deg": 1.3123950932107737, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0034456990600917337, - -0.028757253028442675, - -0.07086920076730535 - ], - "translation_xyz_cm": [ - 0.34456990600917337, - -2.8757253028442675, - -7.086920076730535 - ], - "translation_norm_m": 0.0765591017525103, - "rotation_rpy_deg_xyz": [ - 0.4853978608569899, - 0.5595428777659305, - -0.07961400153490089 - ], - "rotation_angle_deg": 0.7452604514073777, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.017280331047126785, - 0.01910413758665841, - -0.045878140905336054 - ], - "translation_xyz_cm": [ - -1.7280331047126785, - 1.910413758665841, - -4.587814090533605 - ], - "translation_norm_m": 0.0526154133971989, - "rotation_rpy_deg_xyz": [ - 0.0370853942695332, - 0.2595280346431109, - 0.07676067119430184 - ], - "rotation_angle_deg": 0.27314725109349947, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02978974058194983, - 0.024457451410303643, - -0.07402727550482269 - ], - "translation_xyz_cm": [ - -2.978974058194983, - 2.4457451410303643, - -7.402727550482268 - ], - "translation_norm_m": 0.08346036839179512, - "rotation_rpy_deg_xyz": [ - 0.2053930322267262, - 0.9344786865517752, - 0.32436639689386765 - ], - "rotation_angle_deg": 1.0097327844707245, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008084061599809622, - 0.013247332244573418, - -0.038265444635174714 - ], - "translation_xyz_cm": [ - -0.8084061599809622, - 1.3247332244573418, - -3.8265444635174712 - ], - "translation_norm_m": 0.04129271263401391, - "rotation_rpy_deg_xyz": [ - 0.4512435396553447, - 0.7491666484307656, - 0.2511669438449359 - ], - "rotation_angle_deg": 0.909104048809833, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.010769702066319775, - 0.002834600895287309, - 0.055653372105624294 - ], - "translation_xyz_cm": [ - 1.0769702066319775, - 0.2834600895287309, - 5.565337210562429 - ], - "translation_norm_m": 0.056756667199192874, - "rotation_rpy_deg_xyz": [ - 1.2012352341832784, - 0.10475685568110953, - -0.2704645733855335 - ], - "rotation_angle_deg": 1.2359943715241535, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008101770819068488, - 0.013524540245845262, - 0.002375105343916592 - ], - "translation_xyz_cm": [ - -0.8101770819068488, - 1.3524540245845262, - 0.2375105343916592 - ], - "translation_norm_m": 0.015943431395433638, - "rotation_rpy_deg_xyz": [ - 1.0713447720263547, - 0.5121752138367888, - 0.40743318306217746 - ], - "rotation_angle_deg": 1.2538697439763702, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.01118625387650507, - 0.014321811494298231, - -3.244493679074867e-05 - ], - "translation_xyz_cm": [ - 1.118625387650507, - 1.432181149429823, - -0.003244493679074867 - ], - "translation_norm_m": 0.01817271616852475, - "rotation_rpy_deg_xyz": [ - 0.5963162220275844, - 1.1682207880887046, - -0.49627472684108254 - ], - "rotation_angle_deg": 1.4045042960916836, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006672103274932617, - 0.041006888783805984, - 0.07960750826531897 - ], - "translation_xyz_cm": [ - -0.6672103274932617, - 4.100688878380598, - 7.960750826531897 - ], - "translation_norm_m": 0.08979664393534777, - "rotation_rpy_deg_xyz": [ - -1.3518977233072038, - -0.5887828415265969, - 0.6092766048205575 - ], - "rotation_angle_deg": 1.5927993601758728, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.020763472264783367, - 0.02623701734447481, - 0.06720389819137694 - ], - "translation_xyz_cm": [ - 2.0763472264783367, - 2.623701734447481, - 6.720389819137694 - ], - "translation_norm_m": 0.07507241032324496, - "rotation_rpy_deg_xyz": [ - -0.6519656961689877, - -0.26614639806366813, - 0.487341898279799 - ], - "rotation_angle_deg": 0.8555206880109816, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005366209049132653, - 0.000989232482801583, - 0.037564602408942466 - ], - "translation_xyz_cm": [ - -0.5366209049132653, - 0.0989232482801583, - 3.7564602408942465 - ], - "translation_norm_m": 0.03795884790936033, - "rotation_rpy_deg_xyz": [ - 0.3500276236705358, - -1.327354870754006, - 0.23142994607986764 - ], - "rotation_angle_deg": 1.3927737545857246, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015716096532251367, - 0.009854966100386553, - 0.03952962168282935 - ], - "translation_xyz_cm": [ - -1.5716096532251367, - 0.9854966100386553, - 3.952962168282935 - ], - "translation_norm_m": 0.04366585665526813, - "rotation_rpy_deg_xyz": [ - -1.0131171064072237, - -1.2836045800187992, - 0.16901535319157182 - ], - "rotation_angle_deg": 1.6427818388020845, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007553751863486058, - 0.02182087119397691, - -0.049227247246865946 - ], - "translation_xyz_cm": [ - 0.7553751863486058, - 2.182087119397691, - -4.922724724686595 - ], - "translation_norm_m": 0.054373996159775874, - "rotation_rpy_deg_xyz": [ - -0.5939558638522894, - -0.5117705896491087, - 0.08225849489829219 - ], - "rotation_angle_deg": 0.7880484189739134, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006422617548786924, - 0.00492204585157574, - -0.01667839688890336 - ], - "translation_xyz_cm": [ - -0.6422617548786924, - 0.49220458515757404, - -1.667839688890336 - ], - "translation_norm_m": 0.018537677155641183, - "rotation_rpy_deg_xyz": [ - -0.11209418099713042, - -0.28929229841052456, - -0.05467203590486332 - ], - "rotation_angle_deg": 0.31507948180637074, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01000945456388247, - 0.025111856304408153, - -0.03165662387598633 - ], - "translation_xyz_cm": [ - 1.000945456388247, - 2.5111856304408153, - -3.1656623875986325 - ], - "translation_norm_m": 0.04162855201595821, - "rotation_rpy_deg_xyz": [ - 0.6855824704406601, - 0.17954563693395836, - -0.1519311487658391 - ], - "rotation_angle_deg": 0.7250301793802022, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0028880117640086578, - 0.0027325280432729526, - 0.02159139874323638 - ], - "translation_xyz_cm": [ - 0.2888011764008658, - 0.27325280432729526, - 2.159139874323638 - ], - "translation_norm_m": 0.021954403229096323, - "rotation_rpy_deg_xyz": [ - 1.1090365378655247, - -0.20826684949977023, - 0.017093771980973595 - ], - "rotation_angle_deg": 1.1285817941483023, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0683357100368478, - "improved_pairs": 15, - "worsened_pairs": 24, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09642312056064384, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667892170896, - 0.0011901746480735614, - 0.7159624384405358 - ], - "rotation_rpy_deg_xyz": [ - -0.8880870599061297, - 1.4011794298989813, - -0.8376743139361774 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07986863254178682, - "median": 0.05315025929440376, - "p90": 0.12178981709267989, - "p95": 0.14510436245660635, - "max": 0.23311816826048312 - }, - "rotation_deg": { - "rms": 0.989129669887256, - "median": 0.8829294587106913, - "p90": 1.4582728632414557, - "p95": 1.5688906345623652, - "max": 1.9259077626308265 - }, - "normalized_pair_score": { - "rms": 2.5426579402355864, - "median": 2.2743216304670923, - "p90": 3.525599208822571, - "p95": 3.946999311750785, - "max": 4.780635718232892 - }, - "normalized_global_rms": 2.5426579402355864 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02118873542198385, - -0.015609536269950652, - 0.12768326261243312 - ], - "translation_xyz_cm": [ - 2.118873542198385, - -1.5609536269950652, - 12.768326261243313 - ], - "translation_norm_m": 0.13036731063691273, - "rotation_rpy_deg_xyz": [ - -0.2418540226149386, - -0.14507836952473746, - -0.34406385996642225 - ], - "rotation_angle_deg": 0.44511961856905025, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6816953294526065, - "median": 0.7204657180292057, - "p90": 2.2714964920288296, - "p95": 3.825941572676517, - "max": 5.676337113128431 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02118873542198385, - -0.015609536269950652, - 0.12768326261243312 - ], - "translation_xyz_cm": [ - 2.118873542198385, - -1.5609536269950652, - 12.768326261243313 - ], - "translation_norm_m": 0.13036731063691273, - "rotation_rpy_deg_xyz": [ - -0.2418540226149386, - -0.14507836952473746, - -0.34406385996642225 - ], - "rotation_angle_deg": 0.44511961856905025, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.034187422821581825, - 0.007826099760466887, - 0.10355093870014236 - ], - "translation_xyz_cm": [ - 3.4187422821581825, - 0.7826099760466887, - 10.355093870014235 - ], - "translation_norm_m": 0.10932897430380949, - "rotation_rpy_deg_xyz": [ - -0.17233618989507188, - -0.1757468117407714, - -0.3988360352824728 - ], - "rotation_angle_deg": 0.4689002568662313, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034628846199888264, - -0.018859654846083873, - 0.04540603137867161 - ], - "translation_xyz_cm": [ - 3.4628846199888264, - -1.8859654846083873, - 4.54060313786716 - ], - "translation_norm_m": 0.06013776896102682, - "rotation_rpy_deg_xyz": [ - 0.29534389433904523, - 0.10705200999236439, - -0.34998680599330545 - ], - "rotation_angle_deg": 0.4705015534970398, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04669959990172434, - 0.01140457545255602, - 0.022672297872694282 - ], - "translation_xyz_cm": [ - 4.669959990172434, - 1.140457545255602, - 2.2672297872694283 - ], - "translation_norm_m": 0.05315025929440376, - "rotation_rpy_deg_xyz": [ - 0.4422807279707848, - 0.31989023520893, - -0.38115890926659507 - ], - "rotation_angle_deg": 0.6664560850091904, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.005622716556953506, - 0.020707480418980823, - -0.010098613521045418 - ], - "translation_xyz_cm": [ - 0.5622716556953505, - 2.0707480418980824, - -1.0098613521045419 - ], - "translation_norm_m": 0.023714904212957612, - "rotation_rpy_deg_xyz": [ - 0.3017742828763355, - 0.23975635368863432, - -0.03279109359622179 - ], - "rotation_angle_deg": 0.3868686520623362, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031950423034711885, - 2.9707218591024098e-05, - -0.07152415334531535 - ], - "translation_xyz_cm": [ - -3.1950423034711886, - 0.00297072185910241, - -7.152415334531535 - ], - "translation_norm_m": 0.07833603849046791, - "rotation_rpy_deg_xyz": [ - 0.6330196157388501, - 0.5815985041822255, - 0.5367690337922438 - ], - "rotation_angle_deg": 1.0117478481643591, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0309254974468276, - -0.020363930882593334, - -0.051123472949776996 - ], - "translation_xyz_cm": [ - -3.09254974468276, - -2.0363930882593335, - -5.1123472949777 - ], - "translation_norm_m": 0.06312436581678552, - "rotation_rpy_deg_xyz": [ - 0.5301370745418749, - 0.3943207958119903, - 0.5875191260010544 - ], - "rotation_angle_deg": 0.8829294587106913, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03740999286786298, - -0.038012697412351304, - -0.07733007985358507 - ], - "translation_xyz_cm": [ - -3.740999286786298, - -3.8012697412351306, - -7.733007985358507 - ], - "translation_norm_m": 0.0939383520246038, - "rotation_rpy_deg_xyz": [ - 0.7001515462618214, - 0.854671857879406, - 0.504022002253132 - ], - "rotation_angle_deg": 1.212201864409844, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012937751111876783, - -0.010551132879353053, - -0.03065670679857446 - ], - "translation_xyz_cm": [ - -1.2937751111876783, - -1.0551132879353053, - -3.065670679857446 - ], - "translation_norm_m": 0.03490767079890028, - "rotation_rpy_deg_xyz": [ - 0.36198494354678357, - 0.3008971111901856, - -0.08634434348935659 - ], - "rotation_angle_deg": 0.47873929801643317, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.00874757021346606, - 0.015789094070698173, - -0.13665037853038559 - ], - "translation_xyz_cm": [ - 0.874757021346606, - 1.5789094070698173, - -13.665037853038559 - ], - "translation_norm_m": 0.13783737312032082, - "rotation_rpy_deg_xyz": [ - -0.7674964661658625, - 0.7169534998144673, - 0.29209709094510655 - ], - "rotation_angle_deg": 1.0914160684125922, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0019609408434754227, - -0.002374756254913346, - 0.0015605147353553485 - ], - "translation_xyz_cm": [ - 0.19609408434754227, - -0.2374756254913346, - 0.15605147353553483 - ], - "translation_norm_m": 0.0034525298696928513, - "rotation_rpy_deg_xyz": [ - 0.22621184482600595, - -0.23249026314661073, - -0.4764680283668011 - ], - "rotation_angle_deg": 0.5760271473832896, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010562141009244186, - 0.020449264255443245, - -0.06297604004403039 - ], - "translation_xyz_cm": [ - 1.0562141009244186, - 2.0449264255443245, - -6.297604004403039 - ], - "translation_norm_m": 0.06705007718799007, - "rotation_rpy_deg_xyz": [ - 0.09439266660044536, - 0.03354128418620416, - 0.007100577041866337 - ], - "rotation_angle_deg": 0.10042419437572178, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013078460162727623, - 0.040134113374020286, - -0.11195194961771592 - ], - "translation_xyz_cm": [ - 1.3078460162727623, - 4.013411337402029, - -11.195194961771591 - ], - "translation_norm_m": 0.11964544370662164, - "rotation_rpy_deg_xyz": [ - -0.8697482458371678, - -0.1480768269894866, - 0.16833582974942987 - ], - "rotation_angle_deg": 0.8979678963314063, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0070261610932721985, - 0.016578369201178056, - -0.0536110360803175 - ], - "translation_xyz_cm": [ - 0.7026161093272199, - 1.6578369201178056, - -5.36110360803175 - ], - "translation_norm_m": 0.05655397823923872, - "rotation_rpy_deg_xyz": [ - -0.9009000989928097, - -0.05273910636938967, - 0.16605654654750157 - ], - "rotation_angle_deg": 0.9175177645063037, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0004399575749562956, - 0.008482939299369052, - 0.010756026242157105 - ], - "translation_xyz_cm": [ - 0.04399575749562956, - 0.8482939299369052, - 1.0756026242157106 - ], - "translation_norm_m": 0.013705689415221463, - "rotation_rpy_deg_xyz": [ - 0.01220749222764503, - 1.8649473919358657, - 0.48078516425100726 - ], - "rotation_angle_deg": 1.9259077626308265, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03646730914906715, - -0.007429735397891157, - 0.23012825721424696 - ], - "translation_xyz_cm": [ - 3.646730914906715, - -0.7429735397891157, - 23.012825721424697 - ], - "translation_norm_m": 0.23311816826048312, - "rotation_rpy_deg_xyz": [ - 0.20815453553090077, - -0.1499324297124423, - -0.2450266819100822 - ], - "rotation_angle_deg": 0.35455962473243163, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010146738762454977, - 0.02420968941446633, - 0.2088641756576748 - ], - "translation_xyz_cm": [ - -1.0146738762454977, - 2.420968941446633, - 20.88641756576748 - ], - "translation_norm_m": 0.210507266483175, - "rotation_rpy_deg_xyz": [ - 0.8530897983719065, - -0.28268257421163223, - -0.6910403064367562 - ], - "rotation_angle_deg": 1.1323818010676363, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0017243954807127926, - -0.004640655024457985, - -0.05173335082370843 - ], - "translation_xyz_cm": [ - 0.17243954807127926, - -0.4640655024457985, - -5.173335082370843 - ], - "translation_norm_m": 0.05196969122747242, - "rotation_rpy_deg_xyz": [ - -0.4088325476548906, - 0.7038008988485257, - 0.09305929523078052 - ], - "rotation_angle_deg": 0.8195150284001523, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006348178668695859, - 0.026375044741966835, - 0.035191925623644565 - ], - "translation_xyz_cm": [ - 0.06348178668695859, - 2.6375044741966835, - 3.5191925623644567 - ], - "translation_norm_m": 0.04398315141011363, - "rotation_rpy_deg_xyz": [ - -0.7445818153138412, - -0.021545785806351456, - -0.7379821838797836 - ], - "rotation_angle_deg": 1.048657693866843, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015383567676146015, - -0.04136243647205484, - -0.020541912482167614 - ], - "translation_xyz_cm": [ - 1.5383567676146015, - -4.136243647205484, - -2.0541912482167612 - ], - "translation_norm_m": 0.048677258281217634, - "rotation_rpy_deg_xyz": [ - 0.21928945158048752, - 0.17836678087840258, - -0.6416915735795427 - ], - "rotation_angle_deg": 0.7015039811043354, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.007504162260566716, - -0.012880044259107992, - -0.011040319717752878 - ], - "translation_xyz_cm": [ - 0.7504162260566716, - -1.2880044259107992, - -1.1040319717752878 - ], - "translation_norm_m": 0.018549842339483574, - "rotation_rpy_deg_xyz": [ - -1.2798054310636306, - -0.9534785736787509, - 0.15248962768500685 - ], - "rotation_angle_deg": 1.6021827112737996, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.007168244893041464, - 0.00265880474117218, - 0.05579366903420734 - ], - "translation_xyz_cm": [ - 0.7168244893041464, - 0.265880474117218, - 5.579366903420734 - ], - "translation_norm_m": 0.05631506443037211, - "rotation_rpy_deg_xyz": [ - -0.23978605413750892, - -0.19347954393461095, - -0.1340614928944615 - ], - "rotation_angle_deg": 0.33617350319494377, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.007287610351404794, - -0.027009093420932828, - 0.011489255684468389 - ], - "translation_xyz_cm": [ - -0.7287610351404794, - -2.700909342093283, - 1.148925568446839 - ], - "translation_norm_m": 0.030242410423735547, - "rotation_rpy_deg_xyz": [ - 0.9015192205847944, - 0.08681840489389321, - -0.20230751191186624 - ], - "rotation_angle_deg": 0.9281584039245215, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.01079135854162816, - 0.02054147625377567, - 0.03313881297825094 - ], - "translation_xyz_cm": [ - -1.079135854162816, - 2.054147625377567, - 3.313881297825094 - ], - "translation_norm_m": 0.04045474745275138, - "rotation_rpy_deg_xyz": [ - 0.20362339466301457, - 1.2020283837049592, - -0.2784957801004705 - ], - "rotation_angle_deg": 1.2510315251871484, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021671074909486165, - -0.030166267803071856, - -0.06516361851235676 - ], - "translation_xyz_cm": [ - 0.21671074909486165, - -3.0166267803071856, - -6.5163618512356765 - ], - "translation_norm_m": 0.07184008105276567, - "rotation_rpy_deg_xyz": [ - 0.5875558825335884, - 0.4609998337939518, - -0.07965236006563277 - ], - "rotation_angle_deg": 0.7513067688769995, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.018385526298199117, - 0.01826169598266003, - -0.04379710129184038 - ], - "translation_xyz_cm": [ - -1.8385526298199117, - 1.8261695982660031, - -4.379710129184038 - ], - "translation_norm_m": 0.050889126530061404, - "rotation_rpy_deg_xyz": [ - 0.0989893684579667, - 0.1685083813025341, - 0.076675795329284 - ], - "rotation_angle_deg": 0.20988285259820716, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.030906095118024668, - 0.022998466202759915, - -0.07281837328519915 - ], - "translation_xyz_cm": [ - -3.090609511802467, - 2.2998466202759915, - -7.281837328519915 - ], - "translation_norm_m": 0.08238101511286737, - "rotation_rpy_deg_xyz": [ - 0.3205919517214839, - 0.8370724366221942, - 0.32514089474038266 - ], - "rotation_angle_deg": 0.9527115011977059, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008726078752184119, - 0.013005432959144692, - -0.03714192705931947 - ], - "translation_xyz_cm": [ - -0.8726078752184119, - 1.3005432959144692, - -3.7141927059319473 - ], - "translation_norm_m": 0.04030891318956558, - "rotation_rpy_deg_xyz": [ - 0.46638929712082594, - 0.697681800664475, - 0.2502820426655999 - ], - "rotation_angle_deg": 0.8749255828077164, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.009685542120729362, - 0.0008827123197421294, - 0.05543621781399344 - ], - "translation_xyz_cm": [ - 0.9685542120729362, - 0.08827123197421294, - 5.543621781399343 - ], - "translation_norm_m": 0.056282885078257766, - "rotation_rpy_deg_xyz": [ - 1.3553268091951465, - 0.022066309180181258, - -0.26989496897840287 - ], - "rotation_angle_deg": 1.3821644021573776, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008844482773376239, - 0.011053973041791343, - 0.007354166882595423 - ], - "translation_xyz_cm": [ - -0.8844482773376239, - 1.1053973041791343, - 0.7354166882595423 - ], - "translation_norm_m": 0.015953023728254842, - "rotation_rpy_deg_xyz": [ - 1.2547601548553928, - 0.45842643245173226, - 0.4099478198257644 - ], - "rotation_angle_deg": 1.3958880373798794, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.010389900803214225, - 0.01186529925041957, - 0.005157642711380445 - ], - "translation_xyz_cm": [ - 1.0389900803214225, - 1.186529925041957, - 0.5157642711380445 - ], - "translation_norm_m": 0.01659327102595792, - "rotation_rpy_deg_xyz": [ - 0.7780451720476518, - 1.1119722028903116, - -0.4934269812295707 - ], - "rotation_angle_deg": 1.446626076312717, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005849281708567133, - 0.040908087814580885, - 0.07434636638866111 - ], - "translation_xyz_cm": [ - -0.5849281708567133, - 4.0908087814580885, - 7.434636638866111 - ], - "translation_norm_m": 0.08505920256120839, - "rotation_rpy_deg_xyz": [ - -1.3398312390714697, - -0.5396725690969726, - 0.6092220708196656 - ], - "rotation_angle_deg": 1.5651915149277613, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02230550916359597, - 0.025454992230004247, - 0.058547214195144484 - ], - "translation_xyz_cm": [ - 2.230550916359597, - 2.5454992230004247, - 5.854721419514449 - ], - "translation_norm_m": 0.067625946636546, - "rotation_rpy_deg_xyz": [ - -0.5807631684274817, - -0.1689183508787147, - 0.48962883170125776 - ], - "rotation_angle_deg": 0.7776341358424744, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004447584719295072, - 0.0008059892753259912, - 0.034794669467049 - ], - "translation_xyz_cm": [ - -0.44475847192950724, - 0.08059892753259912, - 3.4794669467048998 - ], - "translation_norm_m": 0.03508702968147118, - "rotation_rpy_deg_xyz": [ - 0.370927435300329, - -1.2646592186187953, - 0.23336378744872377 - ], - "rotation_angle_deg": 1.3391457676861183, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.014249037057554315, - 0.008662881437794479, - 0.0349599743036387 - ], - "translation_xyz_cm": [ - -1.4249037057554315, - 0.8662881437794479, - 3.4959974303638703 - ], - "translation_norm_m": 0.03873345292100768, - "rotation_rpy_deg_xyz": [ - -0.9170060314783413, - -1.1822125088192947, - 0.17131903518479694 - ], - "rotation_angle_deg": 1.5048600109564099, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008614508719718694, - 0.019976290643349826, - -0.04879854946916989 - ], - "translation_xyz_cm": [ - 0.8614508719718694, - 1.9976290643349826, - -4.879854946916988 - ], - "translation_norm_m": 0.05342808604699139, - "rotation_rpy_deg_xyz": [ - -0.4455557744195208, - -0.42287976781743497, - 0.08653660683152153 - ], - "rotation_angle_deg": 0.6201211840474964, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005403245834918913, - 0.004513380846663084, - -0.019276798958956162 - ], - "translation_xyz_cm": [ - -0.5403245834918913, - 0.4513380846663084, - -1.9276798958956163 - ], - "translation_norm_m": 0.020522198964136547, - "rotation_rpy_deg_xyz": [ - -0.07745802070064917, - -0.21214323499402324, - -0.05268933571760255 - ], - "rotation_angle_deg": 0.23193913826709664, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011161792026584738, - 0.023990901806485665, - -0.029854056343239385 - ], - "translation_xyz_cm": [ - 1.1161792026584738, - 2.3990901806485665, - -2.9854056343239384 - ], - "translation_norm_m": 0.0398925262534034, - "rotation_rpy_deg_xyz": [ - 0.7688722686685902, - 0.27950412142835496, - -0.14698837379113427 - ], - "rotation_angle_deg": 0.8315302043695855, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003450550833809407, - 0.00265469106567362, - 0.021022561212256635 - ], - "translation_xyz_cm": [ - 0.3450550833809407, - 0.265469106567362, - 2.1022561212256634 - ], - "translation_norm_m": 0.02146862281642554, - "rotation_rpy_deg_xyz": [ - 1.118088512545101, - -0.16522211706214945, - 0.018857373815566788 - ], - "rotation_angle_deg": 1.1304139916357179, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.04351660455864215, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004610571887935899, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667883966867, - -0.00132483596826191, - 0.7159622034133878 - ], - "rotation_rpy_deg_xyz": [ - -0.6880496073495588, - 1.404096019030304, - -0.8334758829122912 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07836629319834118, - "median": 0.05177617207522874, - "p90": 0.11956513463978463, - "p95": 0.14395075537166171, - "max": 0.22926589639958905 - }, - "rotation_deg": { - "rms": 1.0056724288764685, - "median": 0.8934940390715803, - "p90": 1.6059715121628535, - "p95": 1.6926660614356421, - "max": 1.753159980102663 - }, - "normalized_pair_score": { - "rms": 2.5499055866185576, - "median": 2.3151604769645817, - "p90": 3.4594526693733343, - "p95": 3.6793647582088687, - "max": 4.871529959965088 - }, - "normalized_global_rms": 2.5499055866185576 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.01983834457668665, - -0.015504585040189589, - 0.12936397253632068 - ], - "translation_xyz_cm": [ - 1.983834457668665, - -1.550458504018959, - 12.936397253632068 - ], - "translation_norm_m": 0.13179146202690734, - "rotation_rpy_deg_xyz": [ - -0.21985692641757718, - -0.2334013181664172, - -0.3443842361043236 - ], - "rotation_angle_deg": 0.4708734484159498, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.648644705864238, - "median": 0.7384894986865091, - "p90": 2.2872153823956474, - "p95": 3.7684382589726937, - "max": 5.483696631022495 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.01983834457668665, - -0.015504585040189589, - 0.12936397253632068 - ], - "translation_xyz_cm": [ - 1.983834457668665, - -1.550458504018959, - 12.936397253632068 - ], - "translation_norm_m": 0.13179146202690734, - "rotation_rpy_deg_xyz": [ - -0.21985692641757718, - -0.2334013181664172, - -0.3443842361043236 - ], - "rotation_angle_deg": 0.4708734484159498, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03215841779482376, - 0.007488070882689879, - 0.1057559036558589 - ], - "translation_xyz_cm": [ - 3.2158417794823757, - 0.7488070882689879, - 10.575590365585889 - ], - "translation_norm_m": 0.11079055103517599, - "rotation_rpy_deg_xyz": [ - -0.1196467469432824, - -0.3081513953342554, - -0.39902968033958963 - ], - "rotation_angle_deg": 0.5184145137643963, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03400237854132815, - -0.018784816978978658, - 0.046298391215537554 - ], - "translation_xyz_cm": [ - 3.400237854132815, - -1.8784816978978658, - 4.629839121553755 - ], - "translation_norm_m": 0.06043651317331653, - "rotation_rpy_deg_xyz": [ - 0.3012130442605803, - 0.06178117795259717, - -0.3507014983915448 - ], - "rotation_angle_deg": 0.4665311935417798, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.045387311899497074, - 0.011216149960456168, - 0.02420263231449835 - ], - "translation_xyz_cm": [ - 4.538731189949708, - 1.1216149960456168, - 2.420263231449835 - ], - "translation_norm_m": 0.05264577392676899, - "rotation_rpy_deg_xyz": [ - 0.4679653148711452, - 0.22470055626566388, - -0.38259543754061653 - ], - "rotation_angle_deg": 0.6454161610213566, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.004938222482159602, - 0.020608270342872242, - -0.00938929003357111 - ], - "translation_xyz_cm": [ - 0.4938222482159602, - 2.0608270342872244, - -0.9389290033571109 - ], - "translation_norm_m": 0.023178559384541823, - "rotation_rpy_deg_xyz": [ - 0.3097577051373673, - 0.18664432425832636, - -0.0336095959146478 - ], - "rotation_angle_deg": 0.36324835841970443, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03361905395620376, - -0.0008442053845835185, - -0.07070275645747724 - ], - "translation_xyz_cm": [ - -3.3619053956203757, - -0.08442053845835185, - -7.070275645747724 - ], - "translation_norm_m": 0.07829325157589791, - "rotation_rpy_deg_xyz": [ - 0.6926766766182315, - 0.4419749339111483, - 0.5346941291820502 - ], - "rotation_angle_deg": 0.9788648264335834, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.032077029714107724, - -0.02084166332882062, - -0.050810448250677244 - ], - "translation_xyz_cm": [ - -3.2077029714107725, - -2.084166332882062, - -5.081044825067725 - ], - "translation_norm_m": 0.06360041208220593, - "rotation_rpy_deg_xyz": [ - 0.5569339845376506, - 0.2971777537677473, - 0.585917552916602 - ], - "rotation_angle_deg": 0.8602864470229568, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03910985906791155, - -0.03902144042569072, - -0.07637093944039589 - ], - "translation_xyz_cm": [ - -3.9109859067911548, - -3.9021440425690725, - -7.637093944039589 - ], - "translation_norm_m": 0.09425908062471355, - "rotation_rpy_deg_xyz": [ - 0.7672078626242982, - 0.7081141457067361, - 0.5017716188488857 - ], - "rotation_angle_deg": 1.1563027790195821, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013724739555608233, - -0.010750937945598393, - -0.02985952111748592 - ], - "translation_xyz_cm": [ - -1.3724739555608232, - -1.0750937945598393, - -2.985952111748592 - ], - "translation_norm_m": 0.03457661267309122, - "rotation_rpy_deg_xyz": [ - 0.37305631861552224, - 0.23811704847639364, - -0.08733946804193757 - ], - "rotation_angle_deg": 0.45125835251701374, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.00791305279474841, - 0.015117736796860126, - -0.1357388985434119 - ], - "translation_xyz_cm": [ - 0.791305279474841, - 1.5117736796860126, - -13.57388985434119 - ], - "translation_norm_m": 0.13680720356827078, - "rotation_rpy_deg_xyz": [ - -0.748602099535282, - 0.6349659743700895, - 0.29251668240313095 - ], - "rotation_angle_deg": 1.0254617730161373, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00021083493920937002, - -0.0030697368627858324, - 0.0038741462073057023 - ], - "translation_xyz_cm": [ - 0.021083493920937002, - -0.30697368627858324, - 0.3874146207305702 - ], - "translation_norm_m": 0.004947397761845997, - "rotation_rpy_deg_xyz": [ - 0.2798948098075749, - -0.36595893877722646, - -0.4775790372102809 - ], - "rotation_angle_deg": 0.6629430619017354, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010012345431286707, - 0.020119739369975687, - -0.06155909243799722 - ], - "translation_xyz_cm": [ - 1.0012345431286707, - 2.0119739369975687, - -6.155909243799722 - ], - "translation_norm_m": 0.06553299043337671, - "rotation_rpy_deg_xyz": [ - 0.10044818017110235, - -0.012472718023224458, - 0.0065376810065954525 - ], - "rotation_angle_deg": 0.10143120709710246, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011999672212322343, - 0.03941316734725264, - -0.10898097531392557 - ], - "translation_xyz_cm": [ - 1.1999672212322343, - 3.9413167347252642, - -10.898097531392557 - ], - "translation_norm_m": 0.1165085527930039, - "rotation_rpy_deg_xyz": [ - -0.8425283336628414, - -0.24594667650555593, - 0.16911866942622683 - ], - "rotation_angle_deg": 0.8934940390715803, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0063445205389954795, - 0.016278939380289903, - -0.05158305071915964 - ], - "translation_xyz_cm": [ - 0.634452053899548, - 1.6278939380289903, - -5.158305071915964 - ], - "translation_norm_m": 0.05446161886789893, - "rotation_rpy_deg_xyz": [ - -0.8922524435409469, - -0.10807630768911798, - 0.1663730997139781 - ], - "rotation_angle_deg": 0.91388954617272, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.002103537913360487, - 0.005548280524320548, - 0.015699228387622267 - ], - "translation_xyz_cm": [ - -0.2103537913360487, - 0.5548280524320548, - 1.5699228387622266 - ], - "translation_norm_m": 0.016783148110417916, - "rotation_rpy_deg_xyz": [ - 0.23764307206691626, - 1.669428150172129, - 0.48318928967281216 - ], - "rotation_angle_deg": 1.753159980102663, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03346921358318955, - -0.01107419703564938, - 0.22653923535239004 - ], - "translation_xyz_cm": [ - 3.346921358318955, - -1.107419703564938, - 22.653923535239002 - ], - "translation_norm_m": 0.22926589639958905, - "rotation_rpy_deg_xyz": [ - 0.4798249841779736, - -0.33378257655495847, - -0.24200606018272505 - ], - "rotation_angle_deg": 0.6320855365331995, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013106862460808166, - 0.023488267446107436, - 0.20649828703671194 - ], - "translation_xyz_cm": [ - -1.3106862460808166, - 2.3488267446107436, - 20.649828703671194 - ], - "translation_norm_m": 0.20824272160217916, - "rotation_rpy_deg_xyz": [ - 0.9560058968720943, - -0.45464073045523223, - -0.6936011235526104 - ], - "rotation_angle_deg": 1.2635062040532659, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -3.2157678040878324e-05, - -0.005499872216122359, - -0.046225606869712874 - ], - "translation_xyz_cm": [ - -0.0032157678040878324, - -0.5499872216122359, - -4.622560686971287 - ], - "translation_norm_m": 0.04655165259132244, - "rotation_rpy_deg_xyz": [ - -0.3482010749585525, - 0.5632329830802514, - 0.09353902827139053 - ], - "rotation_angle_deg": 0.6689873194782009, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0007511322684967681, - 0.02593564448339669, - 0.0343994103711647 - ], - "translation_xyz_cm": [ - -0.0751132268496768, - 2.593564448339669, - 3.43994103711647 - ], - "translation_norm_m": 0.0430876001691637, - "rotation_rpy_deg_xyz": [ - -0.7086879115057579, - -0.13299771174088573, - -0.7372227758705762 - ], - "rotation_angle_deg": 1.031808960510595, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013277145349635422, - -0.04248866777442739, - -0.01059231484054184 - ], - "translation_xyz_cm": [ - 1.3277145349635422, - -4.248866777442739, - -1.0592314840541839 - ], - "translation_norm_m": 0.04575769456126667, - "rotation_rpy_deg_xyz": [ - 0.2953432993096583, - 0.024276594342236574, - -0.642640752760065 - ], - "rotation_angle_deg": 0.7077313416720086, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.005915857270801794, - -0.013186374289907932, - -0.004898498461515383 - ], - "translation_xyz_cm": [ - 0.5915857270801794, - -1.3186374289907932, - -0.48984984615153826 - ], - "translation_norm_m": 0.015260180907823863, - "rotation_rpy_deg_xyz": [ - -1.2480103106897278, - -1.058843996491766, - 0.15414421877221693 - ], - "rotation_angle_deg": 1.642814571668502, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.004374287039567326, - 0.0007838937654551098, - 0.0604585256615161 - ], - "translation_xyz_cm": [ - 0.4374287039567326, - 0.07838937654551098, - 6.04585256615161 - ], - "translation_norm_m": 0.06062163146686376, - "rotation_rpy_deg_xyz": [ - -0.08806771004129846, - -0.3846944983171834, - -0.1324291932841721 - ], - "rotation_angle_deg": 0.41636699811798167, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.007997996819602449, - -0.032217990788736495, - 0.015488778343847528 - ], - "translation_xyz_cm": [ - -0.7997996819602449, - -3.2217990788736497, - 1.548877834384753 - ], - "translation_norm_m": 0.03663153202057376, - "rotation_rpy_deg_xyz": [ - 1.2958400450806427, - 0.04266646215682582, - -0.1941017916906235 - ], - "rotation_angle_deg": 1.3110617730447771, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012670868387613554, - 0.01992757793276212, - 0.037825590104856865 - ], - "translation_xyz_cm": [ - -1.2670868387613554, - 1.992757793276212, - 3.7825590104856865 - ], - "translation_norm_m": 0.044591866239743524, - "rotation_rpy_deg_xyz": [ - 0.2599509179968717, - 1.0657478885400091, - -0.27954207491021793 - ], - "rotation_angle_deg": 1.1326447576219019, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004199725898179629, - -0.03298459317517233, - -0.053765968998156596 - ], - "translation_xyz_cm": [ - -0.04199725898179629, - -3.2984593175172328, - -5.3765968998156595 - ], - "translation_norm_m": 0.0630788331076167, - "rotation_rpy_deg_xyz": [ - 0.7918610937070613, - 0.2639023368677551, - -0.07973284213892447 - ], - "rotation_angle_deg": 0.8386509098504318, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.020605994652241666, - 0.016581126614279462, - -0.03964270443966929 - ], - "translation_xyz_cm": [ - -2.0605994652241666, - 1.6581126614279462, - -3.964270443966929 - ], - "translation_norm_m": 0.0476558998519381, - "rotation_rpy_deg_xyz": [ - 0.22278781569591202, - -0.013537867412669194, - 0.07669208081428176 - ], - "rotation_angle_deg": 0.23601565492143653, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.033145084106716016, - 0.020079745497173396, - -0.07041504316578547 - ], - "translation_xyz_cm": [ - -3.3145084106716016, - 2.0079745497173396, - -7.041504316578546 - ], - "translation_norm_m": 0.08037456739362249, - "rotation_rpy_deg_xyz": [ - 0.5509740610289262, - 0.6422465045093532, - 0.32662070486861217 - ], - "rotation_angle_deg": 0.9059314169765579, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010013261615174407, - 0.012526696010335514, - -0.034896567845720705 - ], - "translation_xyz_cm": [ - -1.0013261615174407, - 1.2526696010335514, - -3.4896567845720705 - ], - "translation_norm_m": 0.038405129455845725, - "rotation_rpy_deg_xyz": [ - 0.4966800732158183, - 0.5947067685194851, - 0.248742067360889 - ], - "rotation_angle_deg": 0.812990987051528, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007518281622342471, - -0.0030199598314828435, - 0.05498157598284424 - ], - "translation_xyz_cm": [ - 0.7518281622342471, - -0.30199598314828435, - 5.498157598284424 - ], - "translation_norm_m": 0.05557533997641308, - "rotation_rpy_deg_xyz": [ - 1.6634984243109143, - -0.14333359187958822, - -0.2689789923828324 - ], - "rotation_angle_deg": 1.6908563838627437, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.010343954282202361, - 0.006091474608785008, - 0.017287273250941357 - ], - "translation_xyz_cm": [ - -1.0343954282202361, - 0.6091474608785008, - 1.7287273250941357 - ], - "translation_norm_m": 0.021046455035337367, - "rotation_rpy_deg_xyz": [ - 1.6215760807623987, - 0.35089750032929207, - 0.4147554148577664 - ], - "rotation_angle_deg": 1.7089531595917278, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008781302678148695, - 0.006930614080590702, - 0.015512996253103276 - ], - "translation_xyz_cm": [ - 0.8781302678148695, - 0.6930614080590702, - 1.5512996253103275 - ], - "translation_norm_m": 0.01912583961576955, - "rotation_rpy_deg_xyz": [ - 1.14148402182609, - 0.9994427669670941, - -0.4879592132363607 - ], - "rotation_angle_deg": 1.5967607472864411, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0042164880377972835, - 0.04068600076668827, - 0.06382172697406434 - ], - "translation_xyz_cm": [ - -0.42164880377972835, - 4.068600076668827, - 6.382172697406434 - ], - "translation_norm_m": 0.07580463220484522, - "rotation_rpy_deg_xyz": [ - -1.3156911465186127, - -0.44145388009391223, - 0.6088879086073773 - ], - "rotation_angle_deg": 1.513429918568732, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.025346406474271, - 0.023877560196617686, - 0.0412226284208161 - ], - "translation_xyz_cm": [ - 2.5346406474271, - 2.3877560196617686, - 4.12226284208161 - ], - "translation_norm_m": 0.0539618689078014, - "rotation_rpy_deg_xyz": [ - -0.4383357914399517, - 0.025533281150201273, - 0.4940616729484009 - ], - "rotation_angle_deg": 0.661046491067773, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0026191289076589186, - 0.00042793997181950205, - 0.02925121531401631 - ], - "translation_xyz_cm": [ - -0.26191289076589186, - 0.042793997181950205, - 2.925121531401631 - ], - "translation_norm_m": 0.029371356219986808, - "rotation_rpy_deg_xyz": [ - 0.41274562167094014, - -1.139262541141826, - 0.2369732815309715 - ], - "rotation_angle_deg": 1.2354641040164327, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01133854338900031, - 0.006277729035329971, - 0.025806871515065652 - ], - "translation_xyz_cm": [ - -1.133854338900031, - 0.6277729035329971, - 2.5806871515065652 - ], - "translation_norm_m": 0.028878487935146024, - "rotation_rpy_deg_xyz": [ - -0.7247604553303281, - -0.9794384570991861, - 0.17591307498083045 - ], - "rotation_angle_deg": 1.2301745445583785, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010738525195524207, - 0.016286270208435982, - -0.04796054080269111 - ], - "translation_xyz_cm": [ - 1.0738525195524207, - 1.6286270208435982, - -4.796054080269111 - ], - "translation_norm_m": 0.05177617207522874, - "rotation_rpy_deg_xyz": [ - -0.14872751926920416, - -0.24512552901504017, - 0.09532935805965427 - ], - "rotation_angle_deg": 0.30204863242621327, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0033747558477470463, - 0.0036871762667178842, - -0.024478586432092192 - ], - "translation_xyz_cm": [ - -0.33747558477470463, - 0.3687176266717884, - -2.4478586432092193 - ], - "translation_norm_m": 0.024983703479811766, - "rotation_rpy_deg_xyz": [ - -0.008168726135522247, - -0.057842414825320244, - -0.04898525449319768 - ], - "rotation_angle_deg": 0.07623930710928334, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.013476039869520395, - 0.02175086923545755, - -0.026259497268802584 - ], - "translation_xyz_cm": [ - 1.3476039869520395, - 2.175086923545755, - -2.6259497268802585 - ], - "translation_norm_m": 0.03666422179554787, - "rotation_rpy_deg_xyz": [ - 0.93548800376033, - 0.4794160617907114, - -0.13718381498058635 - ], - "rotation_angle_deg": 1.0605966008102643, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004574405722232999, - 0.0024963085108008487, - 0.01988339752452991 - ], - "translation_xyz_cm": [ - 0.4574405722232999, - 0.24963085108008487, - 1.9883397524529909 - ], - "translation_norm_m": 0.020554956604458618, - "rotation_rpy_deg_xyz": [ - 1.1362015598108992, - -0.0791255451490655, - 0.02218031439651488 - ], - "rotation_angle_deg": 1.1391845260639735, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0507642509416133, - "improved_pairs": 19, - "worsened_pairs": 20, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.004455671029209851, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.301514381728528, - 0.0024476764333135038, - 0.7136887808759609 - ], - "rotation_rpy_deg_xyz": [ - -0.98957173596909, - 1.4997049033829544, - -0.8398067936647792 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08073488194995813, - "median": 0.05371398392764625, - "p90": 0.1238300898075421, - "p95": 0.14753212263141716, - "max": 0.23418096563683538 - }, - "rotation_deg": { - "rms": 1.0288692761236073, - "median": 0.8934649176086595, - "p90": 1.5419487013980633, - "p95": 1.6304215774959507, - "max": 2.131035055200222 - }, - "normalized_pair_score": { - "rms": 2.6156330810711834, - "median": 2.28971481707029, - "p90": 3.6245344565509083, - "p95": 4.307672361121203, - "max": 4.722511516329409 - }, - "normalized_global_rms": 2.6156330810711834 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021856702474127743, - -0.01628389507877359, - 0.12457968141647374 - ], - "translation_xyz_cm": [ - 2.1856702474127743, - -1.6283895078773591, - 12.457968141647374 - ], - "translation_norm_m": 0.12752638042306833, - "rotation_rpy_deg_xyz": [ - -0.20871087549424475, - -0.08992908671513256, - -0.34253766498908095 - ], - "rotation_angle_deg": 0.4112074527490782, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7135991876939975, - "median": 0.7501993496833461, - "p90": 2.4068068761684835, - "p95": 3.7744794821981595, - "max": 5.799621427831512 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021856702474127743, - -0.01628389507877359, - 0.12457968141647374 - ], - "translation_xyz_cm": [ - 2.1856702474127743, - -1.6283895078773591, - 12.457968141647374 - ], - "translation_norm_m": 0.12752638042306833, - "rotation_rpy_deg_xyz": [ - -0.20871087549424475, - -0.08992908671513256, - -0.34253766498908095 - ], - "rotation_angle_deg": 0.4112074527490782, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.035418549287047574, - 0.007048460250196342, - 0.09992321493663883 - ], - "translation_xyz_cm": [ - 3.5418549287047574, - 0.7048460250196342, - 9.992321493663884 - ], - "translation_norm_m": 0.10624878026956987, - "rotation_rpy_deg_xyz": [ - -0.1325116884956509, - -0.08321580241890679, - -0.3965573320358145 - ], - "rotation_angle_deg": 0.4264014012649048, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03492113210345826, - -0.01917063699226018, - 0.043686431140914604 - ], - "translation_xyz_cm": [ - 3.4921132103458263, - -1.9170636992260182, - 4.36864311409146 - ], - "translation_norm_m": 0.05912277950084951, - "rotation_rpy_deg_xyz": [ - 0.31504066977001116, - 0.13261028984895482, - -0.3489329964018299 - ], - "rotation_angle_deg": 0.48871706557315686, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.047455720349456776, - 0.010896347048949373, - 0.020434654121718302 - ], - "translation_xyz_cm": [ - 4.745572034945678, - 1.0896347048949373, - 2.0434654121718303 - ], - "translation_norm_m": 0.05280483748645812, - "rotation_rpy_deg_xyz": [ - 0.47703065368728603, - 0.3803013815445009, - -0.3788042681618934 - ], - "rotation_angle_deg": 0.7189417739675726, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.006009442582104266, - 0.02042712987058473, - -0.01057252059667046 - ], - "translation_xyz_cm": [ - 0.6009442582104266, - 2.042712987058473, - -1.057252059667046 - ], - "translation_norm_m": 0.023773077770124006, - "rotation_rpy_deg_xyz": [ - 0.32433561928513177, - 0.27029118428046195, - -0.03155254579717572 - ], - "rotation_angle_deg": 0.42343188185652425, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.030687010660929437, - -0.00034129043824709937, - -0.07245287795032951 - ], - "translation_xyz_cm": [ - -3.0687010660929435, - -0.03412904382470994, - -7.245287795032951 - ], - "translation_norm_m": 0.07868436074438541, - "rotation_rpy_deg_xyz": [ - 0.6730124459047927, - 0.6811965056320695, - 0.5405490692126742 - ], - "rotation_angle_deg": 1.0976476543806457, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03011089405543875, - -0.02068414696155768, - -0.05164464762054739 - ], - "translation_xyz_cm": [ - -3.011089405543875, - -2.0684146961557683, - -5.164464762054739 - ], - "translation_norm_m": 0.06325875041601504, - "rotation_rpy_deg_xyz": [ - 0.5653109891689735, - 0.4562630231205246, - 0.590017108953984 - ], - "rotation_angle_deg": 0.934457166253611, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03606793570157982, - -0.03832958223109706, - -0.0784315437487233 - ], - "translation_xyz_cm": [ - -3.606793570157982, - -3.832958223109706, - -7.84315437487233 - ], - "translation_norm_m": 0.09445400952099188, - "rotation_rpy_deg_xyz": [ - 0.7399277947464856, - 0.9614365712140539, - 0.5081204355372686 - ], - "rotation_angle_deg": 1.3129007580472671, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012451944260278694, - -0.010832645884559428, - -0.03111707421378177 - ], - "translation_xyz_cm": [ - -1.2451944260278693, - -1.0832645884559429, - -3.1117074213781772 - ], - "translation_norm_m": 0.03522313785492928, - "rotation_rpy_deg_xyz": [ - 0.3878371998164776, - 0.3378071270643779, - -0.08484330931531564 - ], - "rotation_angle_deg": 0.5214626131111922, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009524985065067382, - 0.01572459484953015, - -0.1400006389503744 - ], - "translation_xyz_cm": [ - 0.9524985065067382, - 1.572459484953015, - -14.00006389503744 - ], - "translation_norm_m": 0.14120257480012435, - "rotation_rpy_deg_xyz": [ - -0.7359504803280884, - 0.7673934748040167, - 0.2930603344317491 - ], - "rotation_angle_deg": 1.10420937508025, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.003144810627101813, - -0.002873007677882622, - 0.0010175579397699516 - ], - "translation_xyz_cm": [ - 0.3144810627101813, - -0.2873007677882622, - 0.10175579397699516 - ], - "translation_norm_m": 0.004379432743894335, - "rotation_rpy_deg_xyz": [ - 0.26607166429433904, - -0.1389489700924768, - -0.4735234266883899 - ], - "rotation_angle_deg": 0.5603742424401951, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011007466859051462, - 0.020372772560280694, - -0.06448972101567134 - ], - "translation_xyz_cm": [ - 1.1007466859051462, - 2.0372772560280694, - -6.448972101567134 - ], - "translation_norm_m": 0.06852107927583426, - "rotation_rpy_deg_xyz": [ - 0.11436566790442429, - 0.0595661259045448, - 0.008080262815954344 - ], - "rotation_angle_deg": 0.12919736092408854, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014025449169186355, - 0.04000169778763918, - -0.11536481266956945 - ], - "translation_xyz_cm": [ - 1.4025449169186355, - 4.000169778763918, - -11.536481266956946 - ], - "translation_norm_m": 0.12290601715366054, - "rotation_rpy_deg_xyz": [ - -0.8344446994448821, - -0.08552564233068592, - 0.16932447128424916 - ], - "rotation_angle_deg": 0.8556119565077912, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007538925567035004, - 0.016416196137580608, - -0.0555422360593153 - ], - "translation_xyz_cm": [ - 0.7538925567035004, - 1.6416196137580608, - -5.554223605931529 - ], - "translation_norm_m": 0.05840605174809812, - "rotation_rpy_deg_xyz": [ - -0.8775660451684503, - -0.020744209052822916, - 0.1666750795183922 - ], - "rotation_angle_deg": 0.8934649176086595, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0030950451100084653, - 0.008719863351088764, - 0.0045604298959720825 - ], - "translation_xyz_cm": [ - 0.3095045110008465, - 0.8719863351088764, - 0.45604298959720824 - ], - "translation_norm_m": 0.010315660033692668, - "rotation_rpy_deg_xyz": [ - -0.0026784990993738585, - 2.075367149021988, - 0.4838730038602838 - ], - "rotation_angle_deg": 2.131035055200222, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03984200721196962, - -0.00712810781373352, - 0.23065673457958652 - ], - "translation_xyz_cm": [ - 3.984200721196962, - -0.712810781373352, - 23.065673457958653 - ], - "translation_norm_m": 0.23418096563683538, - "rotation_rpy_deg_xyz": [ - 0.1641500556785251, - 0.07780319475820995, - -0.24166897865671275 - ], - "rotation_angle_deg": 0.30241740823885727, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.008088805193718684, - 0.023264369787523442, - 0.203009344750324 - ], - "translation_xyz_cm": [ - -0.8088805193718684, - 2.3264369787523442, - 20.3009344750324 - ], - "translation_norm_m": 0.2044980531130516, - "rotation_rpy_deg_xyz": [ - 0.887566585877532, - -0.14533213100229525, - -0.6858279933398516 - ], - "rotation_angle_deg": 1.1303547233182998, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00304853775731162, - -0.0050153289375689525, - -0.058596391242643896 - ], - "translation_xyz_cm": [ - 0.304853775731162, - -0.5015328937568952, - -5.8596391242643895 - ], - "translation_norm_m": 0.05888959308291038, - "rotation_rpy_deg_xyz": [ - -0.3688660467445685, - 0.8043913294891651, - 0.09503641346957155 - ], - "rotation_angle_deg": 0.89029727263952, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0016804106310628342, - 0.02591094633204416, - 0.029396194841183637 - ], - "translation_xyz_cm": [ - 0.16804106310628342, - 2.591094633204416, - 2.9396194841183636 - ], - "translation_norm_m": 0.03922164186838554, - "rotation_rpy_deg_xyz": [ - -0.7068245594514829, - 0.05213052697737454, - -0.7367520989439647 - ], - "rotation_angle_deg": 1.0220770230000462, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.016897010180928707, - -0.04174580360786151, - -0.02482748536383033 - ], - "translation_xyz_cm": [ - 1.6897010180928707, - -4.174580360786151, - -2.482748536383033 - ], - "translation_norm_m": 0.051425918576256474, - "rotation_rpy_deg_xyz": [ - 0.2582868039923888, - 0.2934043998667456, - -0.6383395241878062 - ], - "rotation_angle_deg": 0.7490781928989391, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.008234102130471044, - -0.013345577581940993, - -0.007720757103971659 - ], - "translation_xyz_cm": [ - 0.8234102130471044, - -1.3345577581940993, - -0.7720757103971659 - ], - "translation_norm_m": 0.017478986502345112, - "rotation_rpy_deg_xyz": [ - -1.2430584362087147, - -0.8848678460711231, - 0.15303406598245656 - ], - "rotation_angle_deg": 1.5325256343686569, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.009451617117289146, - 0.002270733148463905, - 0.05425283677765851 - ], - "translation_xyz_cm": [ - 0.9451617117289146, - 0.22707331484639048, - 5.425283677765851 - ], - "translation_norm_m": 0.0551167814153423, - "rotation_rpy_deg_xyz": [ - -0.22009894992399132, - -0.022018695375128777, - -0.13144135220319145 - ], - "rotation_angle_deg": 0.2573252718256102, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0042823969684397944, - -0.024556983229219342, - 0.0042816766353913766 - ], - "translation_xyz_cm": [ - -0.42823969684397944, - -2.4556983229219345, - 0.42816766353913766 - ], - "translation_norm_m": 0.025292629438742005, - "rotation_rpy_deg_xyz": [ - 0.7262857895340283, - 0.3059867820063376, - -0.20004009381057433 - ], - "rotation_angle_deg": 0.8135779073549219, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.009585249532476858, - 0.020020120210054948, - 0.025649193253141786 - ], - "translation_xyz_cm": [ - -0.9585249532476858, - 2.002012021005495, - 2.5649193253141784 - ], - "translation_norm_m": 0.033919954840210396, - "rotation_rpy_deg_xyz": [ - 0.24362672487551884, - 1.2983115155004061, - -0.27552988255483607 - ], - "rotation_angle_deg": 1.3499624655959195, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.00474423757188136, - -0.02989429283118339, - -0.07269746690809828 - ], - "translation_xyz_cm": [ - 0.474423757188136, - -2.989429283118339, - -7.269746690809828 - ], - "translation_norm_m": 0.07874705219161564, - "rotation_rpy_deg_xyz": [ - 0.5839319721005682, - 0.6616317959527356, - -0.0744053672041109 - ], - "rotation_angle_deg": 0.8858708485334875, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.016525316098469744, - 0.01800655906280857, - -0.043168467603277895 - ], - "translation_xyz_cm": [ - -1.6525316098469744, - 1.800655906280857, - -4.316846760327789 - ], - "translation_norm_m": 0.0496068426394183, - "rotation_rpy_deg_xyz": [ - 0.1280803314427457, - 0.32139899349149403, - 0.08022065036519341 - ], - "rotation_angle_deg": 0.35507680709487327, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.028372969640952372, - 0.02334221220135546, - -0.07293590563828914 - ], - "translation_xyz_cm": [ - -2.8372969640952372, - 2.334221220135546, - -7.293590563828914 - ], - "translation_norm_m": 0.08166719419679441, - "rotation_rpy_deg_xyz": [ - 0.30281490802353767, - 1.0496219755534346, - 0.32932930573176367 - ], - "rotation_angle_deg": 1.1401877864606542, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00785615925959171, - 0.012654500325033458, - -0.03971085428199387 - ], - "translation_xyz_cm": [ - -0.7856159259591711, - 1.2654500325033458, - -3.971085428199387 - ], - "translation_norm_m": 0.04241235155699447, - "rotation_rpy_deg_xyz": [ - 0.5027405314396843, - 0.7642908697969957, - 0.25285723494785856 - ], - "rotation_angle_deg": 0.9482217705558498, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.012590795270947419, - 0.0015740977476244034, - 0.06068024226242286 - ], - "translation_xyz_cm": [ - 1.259079527094742, - 0.15740977476244034, - 6.068024226242286 - ], - "translation_norm_m": 0.06199272304311464, - "rotation_rpy_deg_xyz": [ - 1.2838388210190854, - 0.2586980314758133, - -0.2623748508220815 - ], - "rotation_angle_deg": 1.3362344343892647, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.0057668633578953354, - 0.01299566497435567, - -0.0009327122882002298 - ], - "translation_xyz_cm": [ - -0.5766863357895335, - 1.299566497435567, - -0.09327122882002298 - ], - "translation_norm_m": 0.014248297207978584, - "rotation_rpy_deg_xyz": [ - 1.1250297399899591, - 0.6954550997893817, - 0.4154700312316388 - ], - "rotation_angle_deg": 1.3842934534696463, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.013498938200056543, - 0.013617534886771532, - -0.0018153090248232001 - ], - "translation_xyz_cm": [ - 1.3498938200056543, - 1.3617534886771532, - -0.18153090248232 - ], - "translation_norm_m": 0.019260164479489528, - "rotation_rpy_deg_xyz": [ - 0.6525841363028939, - 1.3498374643306124, - -0.48973704842693533 - ], - "rotation_angle_deg": 1.5796409695156886, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006813887848347022, - 0.041691034775795166, - 0.08615026037189365 - ], - "translation_xyz_cm": [ - -0.6813887848347022, - 4.169103477579517, - 8.615026037189365 - ], - "translation_norm_m": 0.09595018921519374, - "rotation_rpy_deg_xyz": [ - -1.4009784771910934, - -0.5767228112279817, - 0.6079524641453382 - ], - "rotation_angle_deg": 1.629829664042327, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021419292108882715, - 0.0274731295024373, - 0.07426304693289094 - ], - "translation_xyz_cm": [ - 2.1419292108882715, - 2.74731295024373, - 7.426304693289095 - ], - "translation_norm_m": 0.0820277944288404, - "rotation_rpy_deg_xyz": [ - -0.7491674064703252, - -0.1949038344071203, - 0.4852401386300048 - ], - "rotation_angle_deg": 0.9129384235196228, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005233509361304733, - 0.0017130600246506034, - 0.040178879873334614 - ], - "translation_xyz_cm": [ - -0.5233509361304733, - 0.17130600246506034, - 4.017887987333461 - ], - "translation_norm_m": 0.04055448905804108, - "rotation_rpy_deg_xyz": [ - 0.28734904403602907, - -1.306375348377909, - 0.23032119910383025 - ], - "rotation_angle_deg": 1.3578427344423345, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01455167766757759, - 0.011099530712334993, - 0.04025903785197042 - ], - "translation_xyz_cm": [ - -1.455167766757759, - 1.1099530712334993, - 4.025903785197042 - ], - "translation_norm_m": 0.04422376096332752, - "rotation_rpy_deg_xyz": [ - -1.1144200334606658, - -1.187419979950182, - 0.16632373412545948 - ], - "rotation_angle_deg": 1.6357487985785641, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009327574091711588, - 0.022873347622626383, - -0.04769694329281031 - ], - "translation_xyz_cm": [ - 0.9327574091711588, - 2.2873347622626383, - -4.769694329281031 - ], - "translation_norm_m": 0.05371398392764625, - "rotation_rpy_deg_xyz": [ - -0.682840221725416, - -0.36328106706508645, - 0.0809169290041293 - ], - "rotation_angle_deg": 0.7774570463748758, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005962688283054796, - 0.005870392133145108, - -0.01700452047671966 - ], - "translation_xyz_cm": [ - -0.5962688283054796, - 0.5870392133145108, - -1.7004520476719658 - ], - "translation_norm_m": 0.018951751159218745, - "rotation_rpy_deg_xyz": [ - -0.18923362632332452, - -0.25461349024112484, - -0.05611730080946054 - ], - "rotation_angle_deg": 0.32223232246641503, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011123319682821542, - 0.02638097097667913, - -0.034481637439926244 - ], - "translation_xyz_cm": [ - 1.1123319682821542, - 2.638097097667913, - -3.4481637439926245 - ], - "translation_norm_m": 0.04481815693418411, - "rotation_rpy_deg_xyz": [ - 0.5855517523063751, - 0.26287741871452636, - -0.1521004980495623 - ], - "rotation_angle_deg": 0.6599376762552417, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0030447836005043083, - 0.0033624909817165927, - 0.01932921883778843 - ], - "translation_xyz_cm": [ - 0.30447836005043083, - 0.33624909817165927, - 1.932921883778843 - ], - "translation_norm_m": 0.0198543635922973, - "rotation_rpy_deg_xyz": [ - 1.0659723254984081, - -0.19917362622106505, - 0.016332803861987624 - ], - "rotation_angle_deg": 1.0845705429864414, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.11649174539423912, - "improved_pairs": 15, - "worsened_pairs": 24, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10227536531420744, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143983507484, - 0.0011901746480735614, - 0.7136919554572032 - ], - "rotation_rpy_deg_xyz": [ - -0.8895495264961033, - 1.501168742146643, - -0.8377113510014426 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07976001272785865, - "median": 0.052767426256249195, - "p90": 0.12271114390910991, - "p95": 0.1469521002839724, - "max": 0.23223382807642698 - }, - "rotation_deg": { - "rms": 1.020636005744607, - "median": 0.8909634326059546, - "p90": 1.521490194078497, - "p95": 1.6042946853472198, - "max": 2.0387581112740842 - }, - "normalized_pair_score": { - "rms": 2.5906476559016074, - "median": 2.245633882380624, - "p90": 3.565252564959458, - "p95": 4.14517074032059, - "max": 4.707876917580645 - }, - "normalized_global_rms": 2.5906476559016074 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.021184266244200556, - -0.01623694562891087, - 0.12542129174055922 - ], - "translation_xyz_cm": [ - 2.1184266244200556, - -1.623694562891087, - 12.54212917405592 - ], - "translation_norm_m": 0.1282299183557872, - "rotation_rpy_deg_xyz": [ - -0.19771040370425846, - -0.13408915231264432, - -0.34281707909633174 - ], - "rotation_angle_deg": 0.41803263983275235, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6886059172123598, - "median": 0.7291535778684739, - "p90": 2.3232842191178094, - "p95": 3.7417816215363167, - "max": 5.703566170764175 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.05340926734199069, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.021184266244200556, - -0.01623694562891087, - 0.12542129174055922 - ], - "translation_xyz_cm": [ - 2.1184266244200556, - -1.623694562891087, - 12.54212917405592 - ], - "translation_norm_m": 0.1282299183557872, - "rotation_rpy_deg_xyz": [ - -0.19771040370425846, - -0.13408915231264432, - -0.34281707909633174 - ], - "rotation_angle_deg": 0.41803263983275235, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03440893176205129, - 0.0068739739603926875, - 0.1010280105347148 - ], - "translation_xyz_cm": [ - 3.4408931762051287, - 0.6873973960392687, - 10.102801053471481 - ], - "translation_norm_m": 0.10694804820853956, - "rotation_rpy_deg_xyz": [ - -0.10616449155959552, - -0.14941616391528942, - -0.3968149103030593 - ], - "rotation_angle_deg": 0.4372274949422868, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03460869076079831, - -0.01913652342124672, - 0.04413294492525292 - ], - "translation_xyz_cm": [ - 3.460869076079831, - -1.913652342124672, - 4.413294492525292 - ], - "translation_norm_m": 0.05925947040434886, - "rotation_rpy_deg_xyz": [ - 0.31797599530131704, - 0.10997624846666197, - -0.34935234414195465 - ], - "rotation_angle_deg": 0.48524572178978786, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04680178594658846, - 0.010798103274652582, - 0.02120079672230956 - ], - "translation_xyz_cm": [ - 4.680178594658846, - 1.0798103274652582, - 2.120079672230956 - ], - "translation_norm_m": 0.052502190276035525, - "rotation_rpy_deg_xyz": [ - 0.4898731043359302, - 0.33270954679875137, - -0.37964989936230714 - ], - "rotation_angle_deg": 0.7041898566394693, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00566751402637553, - 0.020376421622713886, - -0.010217623314503382 - ], - "translation_xyz_cm": [ - 0.566751402637553, - 2.0376421622713887, - -1.0217623314503381 - ], - "translation_norm_m": 0.023488701530370904, - "rotation_rpy_deg_xyz": [ - 0.32832796765544886, - 0.24373678161622353, - -0.03203468285134926 - ], - "rotation_angle_deg": 0.4102166137663221, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031519899057299634, - -0.0007796807997476618, - -0.07204047748964844 - ], - "translation_xyz_cm": [ - -3.1519899057299634, - -0.07796807997476618, - -7.204047748964844 - ], - "translation_norm_m": 0.07863804636223103, - "rotation_rpy_deg_xyz": [ - 0.7028390759989444, - 0.6113889756994517, - 0.5393475127259789 - ], - "rotation_angle_deg": 1.0745319358398877, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030686122709684335, - -0.020923944115331772, - -0.051487506126032166 - ], - "translation_xyz_cm": [ - -3.0686122709684334, - -2.092394411533177, - -5.148750612603217 - ], - "translation_norm_m": 0.06348553261471097, - "rotation_rpy_deg_xyz": [ - 0.5787092936959236, - 0.4076947521841255, - 0.5890867177935492 - ], - "rotation_angle_deg": 0.9196254710001934, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03691610150837312, - -0.03883555129640065, - -0.07795012584219917 - ], - "translation_xyz_cm": [ - -3.6916101508373123, - -3.883555129640065, - -7.795012584219917 - ], - "translation_norm_m": 0.09458974951804534, - "rotation_rpy_deg_xyz": [ - 0.7734528516471484, - 0.8881621926582501, - 0.5068294049362794 - ], - "rotation_angle_deg": 1.2797811340957572, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012845059483986336, - -0.010933651452035148, - -0.030718232882454496 - ], - "translation_xyz_cm": [ - -1.2845059483986336, - -1.093365145203515, - -3.0718232882454495 - ], - "translation_norm_m": 0.035044972801279876, - "rotation_rpy_deg_xyz": [ - 0.3933734152775861, - 0.30641907301491916, - -0.08542700923560093 - ], - "rotation_angle_deg": 0.506075458723862, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009110417257375047, - 0.01538326208429952, - -0.13954492950924077 - ], - "translation_xyz_cm": [ - 0.9110417257375047, - 1.538326208429952, - -13.954492950924077 - ], - "translation_norm_m": 0.14068557782053107, - "rotation_rpy_deg_xyz": [ - -0.7265026815110706, - 0.7264000231555012, - 0.2931587247335926 - ], - "rotation_angle_deg": 1.0696242278852288, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.002271082939057756, - -0.003222014597859535, - 0.002176082269295731 - ], - "translation_xyz_cm": [ - 0.22710829390577558, - -0.3222014597859535, - 0.2176082269295731 - ], - "translation_norm_m": 0.004502724711509956, - "rotation_rpy_deg_xyz": [ - 0.2929147676390593, - -0.20568025194900466, - -0.4742402334670874 - ], - "rotation_angle_deg": 0.5937236199068581, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.0107333774452667, - 0.020204832039175336, - -0.06378142328297087 - ], - "translation_xyz_cm": [ - 1.07333774452667, - 2.0204832039175336, - -6.378142328297088 - ], - "translation_norm_m": 0.06776068613226512, - "rotation_rpy_deg_xyz": [ - 0.117394315264257, - 0.036560300250528, - 0.007735778504693242 - ], - "rotation_angle_deg": 0.12319635996888008, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01348975060603097, - 0.03963492985620953, - -0.11387896994248202 - ], - "translation_xyz_cm": [ - 1.348975060603097, - 3.9634929856209533, - -11.387896994248202 - ], - "translation_norm_m": 0.12133145029744055, - "rotation_rpy_deg_xyz": [ - -0.8208318571695001, - -0.13446048559291, - 0.16958546422795645 - ], - "rotation_angle_deg": 0.8486909337785505, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007199367236066789, - 0.016262389478755246, - -0.05452822344724287 - ], - "translation_xyz_cm": [ - 0.7199367236066789, - 1.6262389478755246, - -5.452822344724287 - ], - "translation_norm_m": 0.0573552382304435, - "rotation_rpy_deg_xyz": [ - -0.8732407226275165, - -0.04841272798119736, - 0.16675739451234076 - ], - "rotation_angle_deg": 0.8902682474721725, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0018361831331945577, - 0.0072541873584552885, - 0.007039442270357016 - ], - "translation_xyz_cm": [ - 0.18361831331945577, - 0.7254187358455289, - 0.7039442270357016 - ], - "translation_norm_m": 0.010273682407388785, - "rotation_rpy_deg_xyz": [ - 0.11004639020415029, - 1.9776096103806078, - 0.4851308992001362 - ], - "rotation_angle_deg": 2.0387581112740842, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03834057915738032, - -0.008951302280609363, - 0.22887207142941066 - ], - "translation_xyz_cm": [ - 3.8340579157380317, - -0.8951302280609363, - 22.887207142941065 - ], - "translation_norm_m": 0.23223382807642698, - "rotation_rpy_deg_xyz": [ - 0.2999907595514252, - -0.01411939937262211, - -0.23999007941474496 - ], - "rotation_angle_deg": 0.38441016826953633, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009560935506827573, - 0.022898933294352997, - 0.20183105862400014 - ], - "translation_xyz_cm": [ - -0.9560935506827573, - 2.2898933294352997, - 20.183105862400012 - ], - "translation_norm_m": 0.20335080245494366, - "rotation_rpy_deg_xyz": [ - 0.9390232920032411, - -0.2313066306974258, - -0.6872608352087699 - ], - "rotation_angle_deg": 1.1853173459144088, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0021805998687720596, - -0.0054549691448917415, - -0.05584069137681035 - ], - "translation_xyz_cm": [ - 0.21805998687720596, - -0.5454969144891741, - -5.584069137681035 - ], - "translation_norm_m": 0.05614886034105761, - "rotation_rpy_deg_xyz": [ - -0.33854956172323947, - 0.7341086429434062, - 0.09511186202152708 - ], - "rotation_angle_deg": 0.8142410090269525, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0009929261059835603, - 0.025683118873724764, - 0.0290011570425803 - ], - "translation_xyz_cm": [ - 0.09929261059835603, - 2.5683118873724764, - 2.90011570425803 - ], - "translation_norm_m": 0.038751459419513815, - "rotation_rpy_deg_xyz": [ - -0.6888747943185911, - -0.003595076963295106, - -0.7365170174724857 - ], - "rotation_angle_deg": 1.008486005928133, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01585300067187756, - -0.04231642426387827, - -0.019850286899863373 - ], - "translation_xyz_cm": [ - 1.585300067187756, - -4.231642426387827, - -1.9850286899863372 - ], - "translation_norm_m": 0.049356167626650106, - "rotation_rpy_deg_xyz": [ - 0.29631409233498207, - 0.21636237946670253, - -0.6389796436746707 - ], - "rotation_angle_deg": 0.7373080723422089, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0074382676420592375, - -0.013496189342214915, - -0.004648874392575081 - ], - "translation_xyz_cm": [ - 0.7438267642059238, - -1.3496189342214915, - -0.4648874392575081 - ], - "translation_norm_m": 0.01609617921724784, - "rotation_rpy_deg_xyz": [ - -1.2271551663892637, - -0.9375514877185607, - 0.1537227666995716 - ], - "rotation_angle_deg": 1.5509421133110688, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008059215134474496, - 0.0013320515525209464, - 0.05659061066893641 - ], - "translation_xyz_cm": [ - 0.8059215134474496, - 0.13320515525209464, - 5.659061066893641 - ], - "translation_norm_m": 0.05717711540297793, - "rotation_rpy_deg_xyz": [ - -0.14423507376358805, - -0.11762458382787115, - -0.13071789965054312 - ], - "rotation_angle_deg": 0.22751956500413503, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.004634430615497731, - -0.02714760964830515, - 0.00629506689691596 - ], - "translation_xyz_cm": [ - -0.4634430615497731, - -2.714760964830515, - 0.629506689691596 - ], - "translation_norm_m": 0.028250637585429124, - "rotation_rpy_deg_xyz": [ - 0.9234558485972508, - 0.28392037158155653, - -0.19555335955970282 - ], - "rotation_angle_deg": 0.9861616538646055, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010514544946069071, - 0.019702237132058542, - 0.02799447185673256 - ], - "translation_xyz_cm": [ - -1.051454494606907, - 1.9702237132058542, - 2.799447185673256 - ], - "translation_norm_m": 0.03581095164845755, - "rotation_rpy_deg_xyz": [ - 0.2717880807331498, - 1.2301742781325742, - -0.27621586715225116 - ], - "rotation_angle_deg": 1.2903870167805274, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0034688318212228175, - -0.03130323956894021, - -0.06699185058230833 - ], - "translation_xyz_cm": [ - 0.34688318212228175, - -3.130323956894021, - -6.699185058230833 - ], - "translation_norm_m": 0.07402589848260349, - "rotation_rpy_deg_xyz": [ - 0.6860847637329365, - 0.5630848868334735, - -0.07443749532817807 - ], - "rotation_angle_deg": 0.8909634326059546, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.017634879400806547, - 0.01716591701079595, - -0.04108750262152657 - ], - "translation_xyz_cm": [ - -1.7634879400806547, - 1.716591701079595, - -4.1087502621526575 - ], - "translation_norm_m": 0.047894055476399966, - "rotation_rpy_deg_xyz": [ - 0.18998087893118493, - 0.23037825757725086, - 0.08009690934260924 - ], - "rotation_angle_deg": 0.30906494904159015, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0294912103855558, - 0.021882929854869837, - -0.07172704354627303 - ], - "translation_xyz_cm": [ - -2.94912103855558, - 2.1882929854869837, - -7.172704354627303 - ], - "translation_norm_m": 0.08058140532981052, - "rotation_rpy_deg_xyz": [ - 0.41801005413974385, - 0.9522107901338667, - 0.33013668261644724 - ], - "rotation_angle_deg": 1.0900126378646533, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008496837757615727, - 0.012410484191522464, - -0.03858738168224528 - ], - "translation_xyz_cm": [ - -0.8496837757615727, - 1.2410484191522464, - -3.858738168224528 - ], - "translation_norm_m": 0.04141500205044727, - "rotation_rpy_deg_xyz": [ - 0.5178850309371813, - 0.7128065945110065, - 0.2519511900034406 - ], - "rotation_angle_deg": 0.9155050727175903, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.011499252464089782, - -0.0003824876998570481, - 0.060462718194658746 - ], - "translation_xyz_cm": [ - 1.1499252464089782, - -0.03824876998570481, - 6.046271819465875 - ], - "translation_norm_m": 0.06154770016467012, - "rotation_rpy_deg_xyz": [ - 1.4379245566272494, - 0.17599667393341442, - -0.2616578786714958 - ], - "rotation_angle_deg": 1.4724867231348422, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.006506401211152646, - 0.010529965904201743, - 0.00404656850630819 - ], - "translation_xyz_cm": [ - -0.6506401211152646, - 1.0529965904201743, - 0.404656850630819 - ], - "translation_norm_m": 0.01302260171165444, - "rotation_rpy_deg_xyz": [ - 1.3084468296008804, - 0.641692409133129, - 0.41825282942558634 - ], - "rotation_angle_deg": 1.5141272142703541, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.012704405041615185, - 0.011163546426760984, - 0.0033748486252146437 - ], - "translation_xyz_cm": [ - 1.2704405041615185, - 1.1163546426760984, - 0.33748486252146437 - ], - "translation_norm_m": 0.01724576120462586, - "rotation_rpy_deg_xyz": [ - 0.8343187439759819, - 1.2935772732676656, - -0.4866288398791267 - ], - "rotation_angle_deg": 1.6172075196382085, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005985735008223969, - 0.04160234367566362, - 0.08088924194935303 - ], - "translation_xyz_cm": [ - -0.5985735008223969, - 4.160234367566362, - 8.088924194935302 - ], - "translation_norm_m": 0.09115730078297449, - "rotation_rpy_deg_xyz": [ - -1.388912470808575, - -0.527612799921019, - 0.6078781707282284 - ], - "rotation_angle_deg": 1.6028599259815544, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02297304104359288, - 0.02669474361513835, - 0.06560673111578437 - ], - "translation_xyz_cm": [ - 2.297304104359288, - 2.669474361513835, - 6.560673111578437 - ], - "translation_norm_m": 0.07446215897465908, - "rotation_rpy_deg_xyz": [ - -0.6779656892448027, - -0.09767328619455794, - 0.487488848966946 - ], - "rotation_angle_deg": 0.8403907255004832, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004312142517042705, - 0.001533401115344335, - 0.03740916865299525 - ], - "translation_xyz_cm": [ - -0.4312142517042705, - 0.1533401115344335, - 3.740916865299525 - ], - "translation_norm_m": 0.03768808553609574, - "rotation_rpy_deg_xyz": [ - 0.30824911641621877, - -1.2436789195974014, - 0.2322245575380892 - ], - "rotation_angle_deg": 1.3027781244375134, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.013083444477408612, - 0.009907509202872311, - 0.03568946170345781 - ], - "translation_xyz_cm": [ - -1.3083444477408612, - 0.9907509202872311, - 3.568946170345781 - ], - "translation_norm_m": 0.03928196704190124, - "rotation_rpy_deg_xyz": [ - -1.0183099608795763, - -1.0860243879665021, - 0.16861844370543996 - ], - "rotation_angle_deg": 1.4971803658410243, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01039056824918716, - 0.021027548433870447, - -0.04726816658205513 - ], - "translation_xyz_cm": [ - 1.039056824918716, - 2.1027548433870447, - -4.726816658205513 - ], - "translation_norm_m": 0.052767426256249195, - "rotation_rpy_deg_xyz": [ - -0.5344374778893852, - -0.27438589861999546, - 0.08531833282420781 - ], - "rotation_angle_deg": 0.6066063647907448, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00494378848905197, - 0.005461333037447114, - -0.019602928704850666 - ], - "translation_xyz_cm": [ - -0.494378848905197, - 0.5461333037447114, - -1.9602928704850666 - ], - "translation_norm_m": 0.020941394819301132, - "rotation_rpy_deg_xyz": [ - -0.1545979541873174, - -0.17746325052671524, - -0.054176067166299885 - ], - "rotation_angle_deg": 0.2415671694603592, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012270691734974859, - 0.02525920665084258, - -0.0326791782569357 - ], - "translation_xyz_cm": [ - 1.227069173497486, - 2.525920665084258, - -3.2679178256935697 - ], - "translation_norm_m": 0.04308742377809712, - "rotation_rpy_deg_xyz": [ - 0.6688442153717401, - 0.36283957770697794, - -0.14718443094951217 - ], - "rotation_angle_deg": 0.7754289162658738, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003605660117083964, - 0.0032810312248816587, - 0.018760212835223056 - ], - "translation_xyz_cm": [ - 0.3605660117083964, - 0.32810312248816587, - 1.8760212835223056 - ], - "translation_norm_m": 0.019383279815383316, - "rotation_rpy_deg_xyz": [ - 1.075024130982001, - -0.15612850100659434, - 0.018080934453996177 - ], - "rotation_angle_deg": 1.0864769452132907, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0915063202246631, - "improved_pairs": 16, - "worsened_pairs": 23, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09517752543255265, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143971201475, - -0.0013248359682619102, - 0.713691720431845 - ], - "rotation_rpy_deg_xyz": [ - -0.6895047465055957, - 1.5040854381408757, - -0.833512808459901 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.07815149226179761, - "median": 0.05111729328550374, - "p90": 0.12048065610395287, - "p95": 0.14579912381221158, - "max": 0.22838674783059798 - }, - "rotation_deg": { - "rms": 1.036676092226784, - "median": 0.8979084676293785, - "p90": 1.6248632151385893, - "p95": 1.769591048321867, - "max": 1.8764288083424083 - }, - "normalized_pair_score": { - "rms": 2.596507573236926, - "median": 2.3308927348428603, - "p90": 3.6507343018236176, - "p95": 3.8602425872576682, - "max": 4.801056655493727 - }, - "normalized_global_rms": 2.596507573236926 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.019837432632139107, - -0.016139020290202533, - 0.12710201824625125 - ], - "translation_xyz_cm": [ - 1.9837432632139107, - -1.6139020290202533, - 12.710201824625125 - ], - "translation_norm_m": 0.12964919880829426, - "rotation_rpy_deg_xyz": [ - -0.1757143536058827, - -0.22241153503700828, - -0.34316936395109443 - ], - "rotation_angle_deg": 0.44535539842024163, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6556931398905776, - "median": 0.7038478902798858, - "p90": 2.246336260565, - "p95": 3.6834655103174776, - "max": 5.511875843494262 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.019837432632139107, - -0.016139020290202533, - 0.12710201824625125 - ], - "translation_xyz_cm": [ - 1.9837432632139107, - -1.6139020290202533, - 12.710201824625125 - ], - "translation_norm_m": 0.12964919880829426, - "rotation_rpy_deg_xyz": [ - -0.1757143536058827, - -0.22241153503700828, - -0.34316936395109443 - ], - "rotation_angle_deg": 0.44535539842024163, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03238583969692399, - 0.0065294353649325565, - 0.10323305104528144 - ], - "translation_xyz_cm": [ - 3.238583969692399, - 0.6529435364932556, - 10.323305104528144 - ], - "translation_norm_m": 0.10839067749201207, - "rotation_rpy_deg_xyz": [ - -0.053477542941272445, - -0.28182052328638574, - -0.39707289457553935 - ], - "rotation_angle_deg": 0.4899527012149992, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.033983266720985505, - -0.019065983678909604, - 0.04502524016578025 - ], - "translation_xyz_cm": [ - 3.3983266720985505, - -1.9065983678909604, - 4.502524016578025 - ], - "translation_norm_m": 0.059545330653715235, - "rotation_rpy_deg_xyz": [ - 0.32384482008354293, - 0.06470587093450712, - -0.35007582267962295 - ], - "rotation_angle_deg": 0.48139700963600973, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0454919768885107, - 0.010605222857977492, - 0.02273106784603056 - ], - "translation_xyz_cm": [ - 4.54919768885107, - 1.0605222857977492, - 2.2731067846030557 - ], - "translation_norm_m": 0.0519489379921573, - "rotation_rpy_deg_xyz": [ - 0.5155559162542533, - 0.2375208628762036, - -0.38112308388010996 - ], - "rotation_angle_deg": 0.6843112259317502, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.004983135978955691, - 0.020276831984999466, - -0.0095083138609501 - ], - "translation_xyz_cm": [ - 0.4983135978955691, - 2.027683198499947, - -0.9508313860950101 - ], - "translation_norm_m": 0.0229431818196822, - "rotation_rpy_deg_xyz": [ - 0.3363109074938519, - 0.19062529543788628, - -0.032865210258438374 - ], - "rotation_angle_deg": 0.3880203820695361, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03318725764135524, - -0.0016548034047579319, - -0.07121911621631889 - ], - "translation_xyz_cm": [ - -3.318725764135524, - -0.1654803404757932, - -7.121911621631889 - ], - "translation_norm_m": 0.0785894074204382, - "rotation_rpy_deg_xyz": [ - 0.7624913951896787, - 0.4717664298919329, - 0.5372030284413439 - ], - "rotation_angle_deg": 1.043629201856332, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03183701523864235, - -0.021402739118916825, - -0.0511745115325515 - ], - "translation_xyz_cm": [ - -3.183701523864235, - -2.1402739118916827, - -5.11745115325515 - ], - "translation_norm_m": 0.06395704348774421, - "rotation_rpy_deg_xyz": [ - 0.605504263644743, - 0.3105527747182122, - 0.58744709933869 - ], - "rotation_angle_deg": 0.8979084676293785, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038614370341891247, - -0.03984567058915456, - -0.07699103065683538 - ], - "translation_xyz_cm": [ - -3.861437034189125, - -3.984567058915456, - -7.699103065683538 - ], - "translation_norm_m": 0.09490187491931817, - "rotation_rpy_deg_xyz": [ - 0.8405034123607513, - 0.7416054387442135, - 0.5045048250211195 - ], - "rotation_angle_deg": 1.2269650496836761, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013631978420701359, - -0.011133638199885748, - -0.029921060365260255 - ], - "translation_xyz_cm": [ - -1.3631978420701358, - -1.113363819988575, - -2.9921060365260255 - ], - "translation_norm_m": 0.03471395380261331, - "rotation_rpy_deg_xyz": [ - 0.404444080485733, - 0.2436396754344723, - -0.08643879159036653 - ], - "rotation_angle_deg": 0.48016178635002466, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008280248130208667, - 0.01470277037446932, - -0.13863341397473403 - ], - "translation_xyz_cm": [ - 0.8280248130208667, - 1.470277037446932, - -13.863341397473402 - ], - "translation_norm_m": 0.13965656961300524, - "rotation_rpy_deg_xyz": [ - -0.7076095049554771, - 0.6444128042247022, - 0.2935505305988037 - ], - "rotation_angle_deg": 1.0022374714144187, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0005195250018715791, - -0.003915390368792071, - 0.00448967593256876 - ], - "translation_xyz_cm": [ - 0.05195250018715791, - -0.3915390368792071, - 0.448967593256876 - ], - "translation_norm_m": 0.0059797473146518945, - "rotation_rpy_deg_xyz": [ - 0.346594824257409, - -0.33914827388516566, - -0.4754163500468226 - ], - "rotation_angle_deg": 0.6783753930157004, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010184274050746955, - 0.01987258354891608, - -0.06236450892911398 - ], - "translation_xyz_cm": [ - 1.0184274050746955, - 1.9872583548916078, - -6.236450892911398 - ], - "translation_norm_m": 0.06624176166753798, - "rotation_rpy_deg_xyz": [ - 0.12344951262075038, - -0.009453270969454568, - 0.007163810121608981 - ], - "rotation_angle_deg": 0.1240185975242474, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012414396253178528, - 0.03890815549096027, - -0.11090791028095685 - ], - "translation_xyz_cm": [ - 1.2414396253178528, - 3.8908155490960272, - -11.090791028095685 - ], - "translation_norm_m": 0.11818852042786748, - "rotation_rpy_deg_xyz": [ - -0.7936129844267639, - -0.23233020797690354, - 0.1703297575998999 - ], - "rotation_angle_deg": 0.8439559383545983, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006518677743704959, - 0.015959886045983973, - -0.05250021745552304 - ], - "translation_xyz_cm": [ - 0.6518677743704959, - 1.5959886045983973, - -5.250021745552304 - ], - "translation_norm_m": 0.0552583383301043, - "rotation_rpy_deg_xyz": [ - -0.8645934388279924, - -0.10374963511312864, - 0.16706091542763948 - ], - "rotation_angle_deg": 0.8865285453010793, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0006945444960360092, - 0.004321290862388194, - 0.011982555143209155 - ], - "translation_xyz_cm": [ - -0.06945444960360092, - 0.4321290862388194, - 1.1982555143209155 - ], - "translation_norm_m": 0.01275686382048432, - "rotation_rpy_deg_xyz": [ - 0.3354769208252955, - 1.7820811842419002, - 0.4875895658755844 - ], - "rotation_angle_deg": 1.8764288083424083, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.035346675034516495, - -0.012594154098606314, - 0.22528316943611654 - ], - "translation_xyz_cm": [ - 3.5346675034516495, - -1.2594154098606314, - 22.528316943611653 - ], - "translation_norm_m": 0.22838674783059798, - "rotation_rpy_deg_xyz": [ - 0.5716540713923016, - -0.19798278411781733, - -0.23679484600545556 - ], - "rotation_angle_deg": 0.6492986730858225, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012499805509178952, - 0.02216538421772407, - 0.19946545117454884 - ], - "translation_xyz_cm": [ - -1.2499805509178952, - 2.216538421772407, - 19.946545117454882 - ], - "translation_norm_m": 0.20108211160506784, - "rotation_rpy_deg_xyz": [ - 1.0419323262277784, - -0.4032648831526395, - -0.6899044017939143 - ], - "rotation_angle_deg": 1.3111577676084054, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00043435864222041154, - -0.00632415166044531, - -0.0503329049850736 - ], - "translation_xyz_cm": [ - 0.043435864222041154, - -0.632415166044531, - -5.03329049850736 - ], - "translation_norm_m": 0.05073051237559928, - "rotation_rpy_deg_xyz": [ - -0.27792170264485505, - 0.5935404576317737, - 0.09552138298618551 - ], - "rotation_angle_deg": 0.6625173986072784, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.00038087613815074306, - 0.02522581750565056, - 0.02820892317808868 - ], - "translation_xyz_cm": [ - -0.038087613815074306, - 2.522581750565056, - 2.820892317808868 - ], - "translation_norm_m": 0.03784481843434194, - "rotation_rpy_deg_xyz": [ - -0.6529823922251429, - -0.11504696282735678, - -0.7358061709119335 - ], - "rotation_angle_deg": 0.9909546407125354, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013744697864550126, - -0.043441115845159084, - -0.009900731492830123 - ], - "translation_xyz_cm": [ - 1.3744697864550126, - -4.344111584515908, - -0.9900731492830124 - ], - "translation_norm_m": 0.04662694231185891, - "rotation_rpy_deg_xyz": [ - 0.37236327460503577, - 0.06227225688750911, - -0.6400071781657749 - ], - "rotation_angle_deg": 0.7432354599498271, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.005837871624343016, - -0.013783818384081992, - 0.0014922663557854488 - ], - "translation_xyz_cm": [ - 0.5837871624343016, - -1.3783818384081992, - 0.14922663557854488 - ], - "translation_norm_m": 0.015043312574837871, - "rotation_rpy_deg_xyz": [ - -1.1953604085028229, - -1.0429171941128337, - 0.15533336214253 - ], - "rotation_angle_deg": 1.5928811760259691, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0052626196896492505, - -0.000542177021255863, - 0.061255363277643006 - ], - "translation_xyz_cm": [ - 0.526261968964925, - -0.0542177021255863, - 6.1255363277643005 - ], - "translation_norm_m": 0.061483401436455004, - "rotation_rpy_deg_xyz": [ - 0.007477904378911511, - -0.30884380613354123, - -0.12914460637116182 - ], - "rotation_angle_deg": 0.3348335389911787, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.005340469899470346, - -0.032338693895048065, - 0.0102952683994907 - ], - "translation_xyz_cm": [ - -0.5340469899470346, - -3.2338693895048065, - 1.02952683994907 - ], - "translation_norm_m": 0.034355556945017206, - "rotation_rpy_deg_xyz": [ - 1.3177875359502709, - 0.2397427355720673, - -0.18667791105911688 - ], - "rotation_angle_deg": 1.352743300230035, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012381646386875556, - 0.019075422433856737, - 0.03268105504500258 - ], - "translation_xyz_cm": [ - -1.2381646386875556, - 1.9075422433856737, - 3.268105504500258 - ], - "translation_norm_m": 0.03981492518056767, - "rotation_rpy_deg_xyz": [ - 0.32811089070650684, - 1.0938943591736778, - -0.27732945476011156 - ], - "rotation_angle_deg": 1.1759696908666009, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008881229455779405, - -0.034121417668073306, - -0.05559411589156823 - ], - "translation_xyz_cm": [ - 0.08881229455779405, - -3.4121417668073306, - -5.559411589156823 - ], - "translation_norm_m": 0.06523622941135306, - "rotation_rpy_deg_xyz": [ - 0.8903794626595006, - 0.3659796465573089, - -0.07450550998247009 - ], - "rotation_angle_deg": 0.9657580817962326, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019864080627680858, - 0.015488953495032542, - -0.03693327955855756 - ], - "translation_xyz_cm": [ - -1.9864080627680858, - 1.5488953495032542, - -3.693327955855756 - ], - "translation_norm_m": 0.04470521802323363, - "rotation_rpy_deg_xyz": [ - 0.3137728508955134, - 0.04832975926921964, - 0.08003547279851742 - ], - "rotation_angle_deg": 0.327373852272857, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.031733973655696746, - 0.01896362797171325, - -0.06932380335701871 - ], - "translation_xyz_cm": [ - -3.1733973655696746, - 1.8963627971713248, - -6.932380335701871 - ], - "translation_norm_m": 0.07856496663088834, - "rotation_rpy_deg_xyz": [ - 0.648384294535184, - 0.7573749471695294, - 0.33168223178732675 - ], - "rotation_angle_deg": 1.049371445715633, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009781342011499106, - 0.011927514108743709, - -0.03634209926234475 - ], - "translation_xyz_cm": [ - -0.9781342011499106, - 1.1927514108743709, - -3.634209926234475 - ], - "translation_norm_m": 0.039480228256107086, - "rotation_rpy_deg_xyz": [ - 0.5481734068618089, - 0.609832612465558, - 0.2503689284770325 - ], - "rotation_angle_deg": 0.8565102494815371, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.009317218084279544, - -0.004294537073065374, - 0.06000729144536707 - ], - "translation_xyz_cm": [ - 0.9317218084279544, - -0.4294537073065374, - 6.000729144536707 - ], - "translation_norm_m": 0.060877981472049335, - "rotation_rpy_deg_xyz": [ - 1.7460832343704367, - 0.010574718333253618, - -0.2604472046921517 - ], - "rotation_angle_deg": 1.7654545891487659, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007999542677307403, - 0.005577214123312801, - 0.013980144067582079 - ], - "translation_xyz_cm": [ - -0.7999542677307403, - 0.5577214123312801, - 1.3980144067582079 - ], - "translation_norm_m": 0.017045305176901136, - "rotation_rpy_deg_xyz": [ - 1.6752646779127547, - 0.5341344758512746, - 0.4235966245176509 - ], - "rotation_angle_deg": 1.8068191808797784, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011099429758935297, - 0.006233920545627214, - 0.013730358832632558 - ], - "translation_xyz_cm": [ - 1.1099429758935297, - 0.6233920545627214, - 1.3730358832632559 - ], - "translation_norm_m": 0.018723831339113865, - "rotation_rpy_deg_xyz": [ - 1.1977673918356821, - 1.1810234990325177, - -0.48064029119017715 - ], - "rotation_angle_deg": 1.7527913715890677, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004342275640175863, - 0.04140047533558422, - 0.07036478968176531 - ], - "translation_xyz_cm": [ - -0.43422756401758633, - 4.1400475335584215, - 7.036478968176531 - ], - "translation_norm_m": 0.08175609055420059, - "rotation_rpy_deg_xyz": [ - -1.3647734339067032, - -0.42939472322973293, - 0.6075044915950952 - ], - "rotation_angle_deg": 1.5523551637824822, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.026037366631039838, - 0.025124582648961002, - 0.04828281754733797 - ], - "translation_xyz_cm": [ - 2.6037366631039838, - 2.5124582648961002, - 4.828281754733797 - ], - "translation_norm_m": 0.06033588968991165, - "rotation_rpy_deg_xyz": [ - -0.535540312693118, - 0.09678330005098018, - 0.4918452634142074 - ], - "rotation_angle_deg": 0.733842794348025, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0024781986277098156, - 0.0011625194842148634, - 0.031866134386988335 - ], - "translation_xyz_cm": [ - -0.24781986277098156, - 0.11625194842148634, - 3.1866134386988336 - ], - "translation_norm_m": 0.03198348700125054, - "rotation_rpy_deg_xyz": [ - 0.3500676267360066, - -1.118280813117824, - 0.23577309223122908 - ], - "rotation_angle_deg": 1.1959487301344318, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.010170602558004838, - 0.007522471915827944, - 0.026536495305336125 - ], - "translation_xyz_cm": [ - -1.0170602558004838, - 0.7522471915827944, - 2.6536495305336123 - ], - "translation_norm_m": 0.029397522399131543, - "rotation_rpy_deg_xyz": [ - -0.8260664722887483, - -0.8832432827622727, - 0.1731945725786607 - ], - "rotation_angle_deg": 1.2207705543911835, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01251905151535615, - 0.01733507577041371, - -0.046430013676781096 - ], - "translation_xyz_cm": [ - 1.251905151535615, - 1.733507577041371, - -4.643001367678109 - ], - "translation_norm_m": 0.05111729328550374, - "rotation_rpy_deg_xyz": [ - -0.2376027461970587, - -0.09662326193737912, - 0.0943577638515474 - ], - "rotation_angle_deg": 0.27323372908576454, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0029162396891575515, - 0.0046343371519921295, - -0.024804725222151207 - ], - "translation_xyz_cm": [ - -0.29162396891575515, - 0.46343371519921295, - -2.4804725222151207 - ], - "translation_norm_m": 0.025401888278420888, - "rotation_rpy_deg_xyz": [ - -0.08530996634165378, - -0.023160215819794987, - -0.05055491465550929 - ], - "rotation_angle_deg": 0.10184168148608404, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0145750099555213, - 0.023017543984789945, - -0.029084809744800086 - ], - "translation_xyz_cm": [ - 1.45750099555213, - 2.3017543984789945, - -2.9084809744800086 - ], - "translation_norm_m": 0.03985178043935431, - "rotation_rpy_deg_xyz": [ - 0.8354650123961268, - 0.5627588542291962, - -0.1374332258214981 - ], - "rotation_angle_deg": 1.0172064079567749, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004726190427944754, - 0.0031154019323061943, - 0.017620733093272334 - ], - "translation_xyz_cm": [ - 0.4726190427944754, - 0.31154019323061943, - 1.7620733093272334 - ], - "translation_norm_m": 0.01850764274307662, - "rotation_rpy_deg_xyz": [ - 1.0931367712721838, - -0.07003121661570053, - 0.021372931860724517 - ], - "rotation_angle_deg": 1.095599182282767, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.09736623755998153, - "improved_pairs": 18, - "worsened_pairs": 21, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.014333648430353563, - "global_consistency_signal": false - } - }, - { - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977515508234834, - -0.004597357058808013, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150315, - 1.2026608220810582, - -1.035510052785851 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08024771376258277, - "median": 0.053309919806184346, - "p90": 0.11844799011749504, - "p95": 0.1446935977026283, - "max": 0.2331571151393798 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011372, - "p90": 1.4226247676045836, - "p95": 1.4793113785217986, - "max": 1.7237415928660536 - }, - "normalized_pair_score": { - "rms": 2.5042597228312786, - "median": 2.3459831609181543, - "p90": 3.3475170230073776, - "p95": 3.607488173628234, - "max": 4.973426198145202 - }, - "normalized_global_rms": 2.5042597228312786 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.02209223460543952, - -0.018020726700241907, - 0.13305462993191253 - ], - "translation_xyz_cm": [ - 2.209223460543952, - -1.8020726700241907, - 13.305462993191252 - ], - "translation_norm_m": 0.13607478813867316, - "rotation_rpy_deg_xyz": [ - -0.31914652144259936, - -0.21122341614483142, - -0.34646275641837543 - ], - "rotation_angle_deg": 0.5166365681634414, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.752893333210111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570956, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.02209223460543952, - -0.018020726700241907, - 0.13305462993191253 - ], - "translation_xyz_cm": [ - 2.209223460543952, - -1.8020726700241907, - 13.305462993191252 - ], - "translation_norm_m": 0.13607478813867316, - "rotation_rpy_deg_xyz": [ - -0.31914652144259936, - -0.21122341614483142, - -0.34646275641837543 - ], - "rotation_angle_deg": 0.5166365681634414, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.034782737187538104, - 0.006203266958609177, - 0.10972025668372652 - ], - "translation_xyz_cm": [ - 3.4782737187538104, - 0.6203266958609177, - 10.972025668372652 - ], - "translation_norm_m": 0.1152686169517096, - "rotation_rpy_deg_xyz": [ - -0.27833863014259475, - -0.2946203532968976, - -0.4025139229771166 - ], - "rotation_angle_deg": 0.5717221816616094, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034811865315541035, - -0.02063602145204535, - 0.0483641294919513 - ], - "translation_xyz_cm": [ - 3.4811865315541035, - -2.063602145204535, - 4.83641294919513 - ], - "translation_norm_m": 0.06306187730817152, - "rotation_rpy_deg_xyz": [ - 0.25301234431144376, - 0.07856507161125245, - -0.35150133642727194 - ], - "rotation_angle_deg": 0.4402983357286551, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04646087619157224, - 0.010172194661397183, - 0.02634250593874724 - ], - "translation_xyz_cm": [ - 4.646087619157225, - 1.0172194661397183, - 2.634250593874724 - ], - "translation_norm_m": 0.054369239279678135, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940171 - ], - "rotation_angle_deg": 0.5821611725015248, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0047454701110814235, - 0.02112711836433176, - -0.009517598854441556 - ], - "translation_xyz_cm": [ - 0.47454701110814235, - 2.112711836433176, - -0.9517598854441556 - ], - "translation_norm_m": 0.023652892104554967, - "rotation_rpy_deg_xyz": [ - 0.2526567759620954, - 0.20523572243396423, - -0.034578606886677916 - ], - "rotation_angle_deg": 0.3273897544800289, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03547722980418585, - -0.00023510086484124226, - -0.07014046073675319 - ], - "translation_xyz_cm": [ - -3.547722980418585, - -0.023510086484124226, - -7.014046073675319 - ], - "translation_norm_m": 0.07860262934126108, - "rotation_rpy_deg_xyz": [ - 0.5232134708787115, - 0.45218792670014574, - 0.5310776539185691 - ], - "rotation_angle_deg": 0.8706732532310362, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.033518858483133754, - -0.020542953718810042, - -0.05028630971691779 - ], - "translation_xyz_cm": [ - -3.3518858483133753, - -2.054295371881004, - -5.028630971691779 - ], - "translation_norm_m": 0.06382977178755458, - "rotation_rpy_deg_xyz": [ - 0.4463900452974913, - 0.318991530825338, - 0.5838735792541094 - ], - "rotation_angle_deg": 0.8002960897011372, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04099366374647419, - -0.03844922721926747, - -0.07566593743095464 - ], - "translation_xyz_cm": [ - -4.099366374647419, - -3.844922721926747, - -7.5665937430954635 - ], - "translation_norm_m": 0.09425580952080881, - "rotation_rpy_deg_xyz": [ - 0.5870852895990375, - 0.7143924390784686, - 0.4978279478250881 - ], - "rotation_angle_deg": 1.0484294819479305, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.014134104373278597, - -0.009970248604019571, - -0.030147293449747342 - ], - "translation_xyz_cm": [ - -1.4134104373278598, - -0.9970248604019571, - -3.014729344974734 - ], - "translation_norm_m": 0.034756842002775026, - "rotation_rpy_deg_xyz": [ - 0.30474184819580336, - 0.25845828464587195, - -0.08851206912855256 - ], - "rotation_angle_deg": 0.40941928556312285, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009084596052393312, - 0.011008964553714806, - -0.13038656635979554 - ], - "translation_xyz_cm": [ - 0.9084596052393312, - 1.1008964553714806, - -13.038656635979553 - ], - "translation_norm_m": 0.13116548278063658, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.29041448129309333 - ], - "rotation_angle_deg": 1.106582027992288, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0016665222487272091, - 0.000302369273450509, - 0.0014459179335448193 - ], - "translation_xyz_cm": [ - -0.1666522248727209, - 0.0302369273450509, - 0.1445917933544819 - ], - "translation_norm_m": 0.0022269715430548957, - "rotation_rpy_deg_xyz": [ - 0.11964371567764986, - -0.35285794691723626, - -0.48101201637706753 - ], - "rotation_angle_deg": 0.608145233254483, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.010691310859906933, - 0.019432172695561523, - -0.0606605333230603 - ], - "translation_xyz_cm": [ - 1.0691310859906933, - 1.9432172695561523, - -6.06605333230603 - ], - "translation_norm_m": 0.06458803114054028, - "rotation_rpy_deg_xyz": [ - 0.05141503904963398, - 0.00449354092149435, - 0.005662578035081809 - ], - "rotation_angle_deg": 0.051920517173624496, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014054342035886513, - 0.03834393454603746, - -0.10654760316415678 - ], - "translation_xyz_cm": [ - 1.4054342035886513, - 3.834393454603746, - -10.654760316415677 - ], - "translation_norm_m": 0.11410597524476587, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.16652151636587267 - ], - "rotation_angle_deg": 0.9937108406424441, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0075852997877216555, - 0.015708647987240587, - -0.050730680236009656 - ], - "translation_xyz_cm": [ - 0.7585299787721655, - 1.5708647987240587, - -5.073068023600966 - ], - "translation_norm_m": 0.05364606520207152, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.1649544244010011 - ], - "rotation_angle_deg": 0.970054673754125, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.001417177958336513, - 0.010278608573110137, - 0.02064514149799443 - ], - "translation_xyz_cm": [ - -0.1417177958336513, - 1.0278608573110137, - 2.064514149799443 - ], - "translation_norm_m": 0.023105844607739828, - "rotation_rpy_deg_xyz": [ - -0.07069970480496512, - 1.5418459142259642, - 0.47434907172896096 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.030619780130571983, - -0.014642186475313679, - 0.23067352639628064 - ], - "translation_xyz_cm": [ - 3.0619780130571983, - -1.4642186475313679, - 23.067352639628062 - ], - "translation_norm_m": 0.2331571151393798, - "rotation_rpy_deg_xyz": [ - 0.16034369761383052, - -0.5134999386071942, - -0.25259308482191417 - ], - "rotation_angle_deg": 0.5939965715201474, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.005669142096515589, - 0.015348355392785784, - 0.22165982567898568 - ], - "translation_xyz_cm": [ - -0.5669142096515589, - 1.5348355392785784, - 22.165982567898567 - ], - "translation_norm_m": 0.22226288377822345, - "rotation_rpy_deg_xyz": [ - 0.7326830017201675, - -0.4714411171372534, - -0.6991490251757558 - ], - "rotation_angle_deg": 1.1151964340680316, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0065056973829920595, - -0.00651425315022891, - -0.04070987050354279 - ], - "translation_xyz_cm": [ - 0.650569738299206, - -0.651425315022891, - -4.0709870503542795 - ], - "translation_norm_m": 0.041737910213133105, - "rotation_rpy_deg_xyz": [ - -0.5190787323237712, - 0.5728926682292592, - 0.08970289125554257 - ], - "rotation_angle_deg": 0.7785618518380146, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.003047158440480313, - 0.01612423201090185, - 0.047277027296241496 - ], - "translation_xyz_cm": [ - 0.3047158440480313, - 1.612423201090185, - 4.727702729624149 - ], - "translation_norm_m": 0.050043914140206355, - "rotation_rpy_deg_xyz": [ - -0.8380523330945313, - -0.11317732429063847, - -0.7401789685625001 - ], - "rotation_angle_deg": 1.124375763416719, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01506677562722869, - -0.03303247254013719, - -0.01681280025847893 - ], - "translation_xyz_cm": [ - 1.506677562722869, - -3.303247254013719, - -1.6812800258478928 - ], - "translation_norm_m": 0.04001027646052548, - "rotation_rpy_deg_xyz": [ - 0.10326906176616632, - 0.025313967913603432, - -0.6469944518488367 - ], - "rotation_angle_deg": 0.6556954445211132, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.002681014467468934, - 0.0015153298205303756, - -0.021051384127350137 - ], - "translation_xyz_cm": [ - 0.2681014467468934, - 0.15153298205303756, - -2.1051384127350135 - ], - "translation_norm_m": 0.021275451504422078, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.15117668573593138 - ], - "rotation_angle_deg": 1.7237415928660536, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - -0.0007294237001627124, - 0.0059449168002362884, - 0.056399786770500164 - ], - "translation_xyz_cm": [ - -0.07294237001627124, - 0.5944916800236288, - 5.639978677050016 - ], - "translation_norm_m": 0.05671692906402793, - "rotation_rpy_deg_xyz": [ - -0.35502558456679695, - -0.4408120377458715, - -0.13900903227030736 - ], - "rotation_angle_deg": 0.5831473606925559, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01560892776380296, - -0.02711371383790917, - 0.023855427044536623 - ], - "translation_xyz_cm": [ - -1.560892776380296, - -2.711371383790917, - 2.385542704453662 - ], - "translation_norm_m": 0.03934302356831329, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.2120103820291368 - ], - "rotation_angle_deg": 1.1246915495033547, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0048724388638325955, - 0.016555725748206296, - 0.04570196729823925 - ], - "translation_xyz_cm": [ - -0.48724388638325955, - 1.6555725748206296, - 4.570196729823925 - ], - "translation_norm_m": 0.048851842651643516, - "rotation_rpy_deg_xyz": [ - 0.09546623284033684, - 1.0775827775049782, - -0.28309517022880515 - ], - "rotation_angle_deg": 1.118457401217174, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0028301573949613967, - -0.022330318830221074, - -0.0556838307011613 - ], - "translation_xyz_cm": [ - -0.2830157394961397, - -2.2330318830221074, - -5.56838307011613 - ], - "translation_norm_m": 0.06006115159980846, - "rotation_rpy_deg_xyz": [ - 0.49268288279378014, - 0.15825199914177118, - -0.08908409912480704 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.02853954413988813, - 0.022752825419550704, - -0.04726765181828505 - ], - "translation_xyz_cm": [ - -2.853954413988813, - 2.2752825419550704, - -4.7267651818285055 - ], - "translation_norm_m": 0.05971957428431487, - "rotation_rpy_deg_xyz": [ - -0.02108664689711348, - -0.04627392585907875, - 0.07066423048105784 - ], - "rotation_angle_deg": 0.08705258513789994, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.04181611136879804, - 0.020626640433104915, - -0.07395128074428872 - ], - "translation_xyz_cm": [ - -4.181611136879804, - 2.0626640433104915, - -7.3951280744288725 - ], - "translation_norm_m": 0.08742332291376785, - "rotation_rpy_deg_xyz": [ - 0.24098676691704196, - 0.5093600460816013, - 0.316941031122525 - ], - "rotation_angle_deg": 0.6459827373704318, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008705213993577876, - 0.012057603039119735, - -0.03315699913695252 - ], - "translation_xyz_cm": [ - -0.8705213993577876, - 1.2057603039119735, - -3.315699913695252 - ], - "translation_norm_m": 0.03633941570101043, - "rotation_rpy_deg_xyz": [ - 0.37854407785868566, - 0.6159343431432545, - 0.2464891649407497 - ], - "rotation_angle_deg": 0.7631660358041191, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00712107026679365, - -0.011127561567771949, - 0.04433844629578218 - ], - "translation_xyz_cm": [ - -0.712107026679365, - -1.1127561567771949, - 4.433844629578218 - ], - "translation_norm_m": 0.04626478237399511, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435075824, - -0.28505939336063874 - ], - "rotation_angle_deg": 1.4218618784137353, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.02157445571594785, - 0.012375879779870536, - 0.01887161887767151 - ], - "translation_xyz_cm": [ - -2.157445571594785, - 1.2375879779870536, - 1.8871618877671512 - ], - "translation_norm_m": 0.031221107264626135, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.396052252285909 - ], - "rotation_angle_deg": 1.3889476012857715, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.00416672114207417, - 0.011585463148090946, - 0.01381971771250444 - ], - "translation_xyz_cm": [ - -0.416672114207417, - 1.1585463148090946, - 1.381971771250444 - ], - "translation_norm_m": 0.018508622830586022, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781138 - ], - "rotation_angle_deg": 1.2068669805108514, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005822859443569861, - 0.05539872553156422, - 0.05584562954024054 - ], - "translation_xyz_cm": [ - -0.5822859443569861, - 5.539872553156422, - 5.5845629540240544 - ], - "translation_norm_m": 0.07887749248909313, - "rotation_rpy_deg_xyz": [ - -1.2295910627015747, - -0.5146874739254865, - 0.6115327195593028 - ], - "rotation_angle_deg": 1.4642363140494419, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.035159258025379, - 0.03980201884486867, - 0.036218321770759135 - ], - "translation_xyz_cm": [ - 3.5159258025379003, - 3.980201884486867, - 3.6218321770759134 - ], - "translation_norm_m": 0.06428173115989258, - "rotation_rpy_deg_xyz": [ - -0.31513998336533705, - -0.2141940157510921, - 0.4953590423367671 - ], - "rotation_angle_deg": 0.6244903967618446, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0022791100855710233, - 0.00574611144449011, - 0.027007479579891774 - ], - "translation_xyz_cm": [ - -0.22791100855710233, - 0.574611144449011, - 2.7007479579891776 - ], - "translation_norm_m": 0.0277058855258756, - "rotation_rpy_deg_xyz": [ - 0.5172047347275823, - -1.243920438445153, - 0.23715544796713608 - ], - "rotation_angle_deg": 1.3688430767407767, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.009553308095984203, - 0.00994974232273993, - 0.02916989939244939 - ], - "translation_xyz_cm": [ - -0.9553308095984203, - 0.994974232273993, - 2.916989939244939 - ], - "translation_norm_m": 0.03226679560215639, - "rotation_rpy_deg_xyz": [ - -0.6182568414692499, - -1.2732199342731065, - 0.17800383183508972 - ], - "rotation_angle_deg": 1.425676324367976, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012349733788234896, - 0.0071781819150057435, - -0.05136054253506888 - ], - "translation_xyz_cm": [ - 1.2349733788234896, - 0.7178181915005744, - -5.136054253506888 - ], - "translation_norm_m": 0.053309919806184346, - "rotation_rpy_deg_xyz": [ - -0.11937661233725183, - -0.6309937842808361, - 0.09193837926716758 - ], - "rotation_angle_deg": 0.6486412679040614, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005762500776254731, - 0.00413490082301915, - -0.021210233278927904 - ], - "translation_xyz_cm": [ - -0.5762500776254731, - 0.413490082301915, - -2.1210233278927904 - ], - "translation_norm_m": 0.02236465550280356, - "rotation_rpy_deg_xyz": [ - 0.11147341198359811, - -0.20435563963405623, - -0.04827864446295908 - ], - "rotation_angle_deg": 0.2376955301690939, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009564601078873913, - 0.012008259673859545, - -0.02269152436915197 - ], - "translation_xyz_cm": [ - 0.9564601078873913, - 1.2008259673859545, - -2.269152436915197 - ], - "translation_norm_m": 0.02739680952937139, - "rotation_rpy_deg_xyz": [ - 1.0522317952095899, - 0.21279800583519293, - -0.14258070238539514 - ], - "rotation_angle_deg": 1.0832171246083169, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.002720793239309627, - -0.0027614729398491855, - 0.024810968227723804 - ], - "translation_xyz_cm": [ - 0.2720793239309627, - -0.27614729398491855, - 2.4810968227723804 - ], - "translation_norm_m": 0.02511200097653933, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334274723 - ], - "rotation_angle_deg": 1.2215923174512227, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.005118387154334325, - "improved_pairs": 18, - "worsened_pairs": 21, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.00023747568828058618, - "global_consistency_signal": false - } - }, - { - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977520208799274, - 0.004462696353922578, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150318, - 1.2026608220810453, - -0.635510052785851 - ] - }, - "all_pairs": { - "count": 39, - "translation_m": { - "rms": 0.08028135387591602, - "median": 0.05427536721167679, - "p90": 0.11886019768032469, - "p95": 0.14390628469662184, - "max": 0.23317621456278564 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011339, - "p90": 1.4226247676045845, - "p95": 1.479311378521798, - "max": 1.7237415928660529 - }, - "normalized_pair_score": { - "rms": 2.5046909681249, - "median": 2.3241131173836513, - "p90": 3.3004971726246692, - "p95": 3.644622533228327, - "max": 5.038342233011214 - }, - "normalized_global_rms": 2.5046909681249 - }, - "selected_pair": { - "translation_xyz_m": [ - 0.018977957315627902, - -0.010544419632784852, - 0.13303730622105003 - ], - "translation_xyz_cm": [ - 1.8977957315627902, - -1.0544419632784852, - 13.303730622105004 - ], - "translation_norm_m": 0.13479715314434312, - "rotation_rpy_deg_xyz": [ - -0.31914652144259953, - -0.21122341614483142, - -0.34646275641837704 - ], - "rotation_angle_deg": 0.5166365681634427, - "pair_index": 0, - "i": 0, - "j": 2 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - 0.018977957315627902, - -0.010544419632784852, - 0.13303730622105003 - ], - "translation_xyz_cm": [ - 1.8977957315627902, - -1.0544419632784852, - 13.303730622105004 - ], - "translation_norm_m": 0.13479715314434312, - "rotation_rpy_deg_xyz": [ - -0.31914652144259953, - -0.21122341614483142, - -0.34646275641837704 - ], - "rotation_angle_deg": 0.5166365681634427, - "pair_index": 0, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030691964249830894, - 0.012971647483750681, - 0.10967170978793495 - ], - "translation_xyz_cm": [ - 3.0691964249830894, - 1.2971647483750681, - 10.967170978793494 - ], - "translation_norm_m": 0.11462174416647401, - "rotation_rpy_deg_xyz": [ - -0.27833863014259486, - -0.2946203532968976, - -0.40251392297711336 - ], - "rotation_angle_deg": 0.5717221816616073, - "pair_index": 1, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03391863028449604, - -0.01588307165538083, - 0.04843205429211943 - ], - "translation_xyz_cm": [ - 3.3918630284496043, - -1.5883071655380832, - 4.843205429211943 - ], - "translation_norm_m": 0.061224254413925684, - "rotation_rpy_deg_xyz": [ - 0.25301234431144376, - 0.07856507161125245, - -0.3515013364272742 - ], - "rotation_angle_deg": 0.4402983357286569, - "pair_index": 2, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04523170697930379, - 0.014903086563413659, - 0.026415847253910878 - ], - "translation_xyz_cm": [ - 4.523170697930379, - 1.490308656341366, - 2.6415847253910876 - ], - "translation_norm_m": 0.054459216772922384, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940189 - ], - "rotation_angle_deg": 0.582161172501526, - "pair_index": 3, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00563711988352532, - 0.02151812222751026, - -0.009494983823284823 - ], - "translation_xyz_cm": [ - 0.563711988352532, - 2.151812222751026, - -0.9494983823284823 - ], - "translation_norm_m": 0.02418597574181675, - "rotation_rpy_deg_xyz": [ - 0.25265677596209546, - 0.20523572243396423, - -0.034578606886678666 - ], - "rotation_angle_deg": 0.32738975448002894, - "pair_index": 4, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031814771562302405, - 0.002674096563466233, - -0.07002645810745761 - ], - "translation_xyz_cm": [ - -3.1814771562302404, - 0.2674096563466233, - -7.002645810745761 - ], - "translation_norm_m": 0.07696125854654239, - "rotation_rpy_deg_xyz": [ - 0.5232134708787116, - 0.45218792670014574, - 0.5310776539185676 - ], - "rotation_angle_deg": 0.8706732532310353, - "pair_index": 5, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030438639522814517, - -0.018412648389471042, - -0.05019333745378557 - ], - "translation_xyz_cm": [ - -3.043863952281452, - -1.8412648389471042, - -5.019333745378557 - ], - "translation_norm_m": 0.0615216020716604, - "rotation_rpy_deg_xyz": [ - 0.4463900452974913, - 0.318991530825338, - 0.5838735792541047 - ], - "rotation_angle_deg": 0.8002960897011339, - "pair_index": 6, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03750265148312712, - -0.03527515584616375, - -0.07556064123872656 - ], - "translation_xyz_cm": [ - -3.750265148312712, - -3.527515584616375, - -7.556064123872656 - ], - "translation_norm_m": 0.09143410738145576, - "rotation_rpy_deg_xyz": [ - 0.5870852895990378, - 0.7143924390784686, - 0.4978279478250889 - ], - "rotation_angle_deg": 1.0484294819479314, - "pair_index": 7, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012899492642063706, - -0.009796543052902063, - -0.030123604990322298 - ], - "translation_xyz_cm": [ - -1.2899492642063706, - -0.9796543052902063, - -3.01236049903223 - ], - "translation_norm_m": 0.03420234997515507, - "rotation_rpy_deg_xyz": [ - 0.3047418481958034, - 0.25845828464587195, - -0.08851206912854949 - ], - "rotation_angle_deg": 0.40941928556312224, - "pair_index": 8, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.006159832747686389, - 0.021566597251051922, - -0.13042403409930997 - ], - "translation_xyz_cm": [ - 0.6159832747686389, - 2.156659725105192, - -13.042403409930998 - ], - "translation_norm_m": 0.13233854437467008, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.2904144812930932 - ], - "rotation_angle_deg": 1.106582027992288, - "pair_index": 9, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0025865182084413574, - -0.002358377205291584, - 0.0015205636432725246 - ], - "translation_xyz_cm": [ - 0.25865182084413574, - -0.2358377205291584, - 0.15205636432725245 - ], - "translation_norm_m": 0.0038162983738538898, - "rotation_rpy_deg_xyz": [ - 0.1196437156776497, - -0.35285794691723626, - -0.48101201637706864 - ], - "rotation_angle_deg": 0.6081452332544839, - "pair_index": 10, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009209302112873963, - 0.022128900702910848, - -0.0606521479458286 - ], - "translation_xyz_cm": [ - 0.9209302112873963, - 2.2128900702910848, - -6.06521479458286 - ], - "translation_norm_m": 0.06521642846835568, - "rotation_rpy_deg_xyz": [ - 0.05141503904963385, - 0.00449354092149435, - 0.00566257803508329 - ], - "rotation_angle_deg": 0.051920517173624524, - "pair_index": 11, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009395879099145299, - 0.04323951223129208, - -0.1066777543289318 - ], - "translation_xyz_cm": [ - 0.9395879099145299, - 4.323951223129208, - -10.66777543289318 - ], - "translation_norm_m": 0.11549061100673828, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.1665215163658755 - ], - "rotation_angle_deg": 0.9937108406424446, - "pair_index": 12, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005104107111166767, - 0.018430765010071015, - -0.05079439415628105 - ], - "translation_xyz_cm": [ - 0.5104107111166767, - 1.8430765010071015, - -5.079439415628105 - ], - "translation_norm_m": 0.05427536721167679, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.16495442440099967 - ], - "rotation_angle_deg": 0.9700546737541248, - "pair_index": 13, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.005887579430009948, - 0.008734099703983977, - 0.02065287929130492 - ], - "translation_xyz_cm": [ - -0.5887579430009948, - 0.8734099703983977, - 2.065287929130492 - ], - "translation_norm_m": 0.023183820052032428, - "rotation_rpy_deg_xyz": [ - -0.07069970480496522, - 1.5418459142259642, - 0.4743490717289602 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 14, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03180599006725193, - 0.002253261740986945, - 0.23098581957600497 - ], - "translation_xyz_cm": [ - 3.1805990067251932, - 0.2253261740986945, - 23.098581957600498 - ], - "translation_norm_m": 0.23317621456278564, - "rotation_rpy_deg_xyz": [ - 0.16034369761383055, - -0.5134999386071942, - -0.2525930848219163 - ], - "rotation_angle_deg": 0.5939965715201482, - "pair_index": 15, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.019908010036874924, - 0.037727357918623916, - 0.2218240696534807 - ], - "translation_xyz_cm": [ - -1.9908010036874924, - 3.7727357918623916, - 22.18240696534807 - ], - "translation_norm_m": 0.22588846866712903, - "rotation_rpy_deg_xyz": [ - 0.7326830017201675, - -0.4714411171372534, - -0.6991490251757558 - ], - "rotation_angle_deg": 1.1151964340680316, - "pair_index": 16, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.006621797638338478, - -0.00028191046255754415, - -0.04082503010634827 - ], - "translation_xyz_cm": [ - -0.6621797638338478, - -0.028191046255754415, - -4.082503010634827 - ], - "translation_norm_m": 0.041359530469484866, - "rotation_rpy_deg_xyz": [ - -0.5190787323237712, - 0.5728926682292592, - 0.08970289125554348 - ], - "rotation_angle_deg": 0.7785618518380149, - "pair_index": 17, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.004530864092607612, - 0.03905345872700372, - 0.04707509343384675 - ], - "translation_xyz_cm": [ - -0.45308640926076116, - 3.905345872700372, - 4.707509343384675 - ], - "translation_norm_m": 0.06133323560495456, - "rotation_rpy_deg_xyz": [ - -0.8380523330945314, - -0.11317732429063847, - -0.7401789685624982 - ], - "rotation_angle_deg": 1.124375763416718, - "pair_index": 18, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.011689147147424972, - -0.04699249176355669, - -0.017096034617821897 - ], - "translation_xyz_cm": [ - 1.1689147147424972, - -4.699249176355669, - -1.7096034617821898 - ], - "translation_norm_m": 0.05135372277484721, - "rotation_rpy_deg_xyz": [ - 0.10326906176616613, - 0.025313967913603432, - -0.6469944518488367 - ], - "rotation_angle_deg": 0.6556954445211132, - "pair_index": 19, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.010923372997102554, - -0.025197399588075542, - -0.02045894923264921 - ], - "translation_xyz_cm": [ - 1.0923372997102554, - -2.519739958807554, - -2.045894923264921 - ], - "translation_norm_m": 0.034246133027527305, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.15117668573592818 - ], - "rotation_angle_deg": 1.7237415928660529, - "pair_index": 20, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008692432957752017, - 0.0028009215659136055, - 0.05664690565726294 - ], - "translation_xyz_cm": [ - 0.8692432957752017, - 0.28009215659136055, - 5.6646905657262945 - ], - "translation_norm_m": 0.05737835369620029, - "rotation_rpy_deg_xyz": [ - -0.355025584566797, - -0.4408120377458715, - -0.13900903227030892 - ], - "rotation_angle_deg": 0.5831473606925561, - "pair_index": 21, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01040412406327551, - -0.03158056569172929, - 0.023852236259414197 - ], - "translation_xyz_cm": [ - -1.040412406327551, - -3.158056569172929, - 2.38522362594142 - ], - "translation_norm_m": 0.04092074170281584, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.21201038202913441 - ], - "rotation_angle_deg": 1.1246915495033545, - "pair_index": 22, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019667955088666478, - 0.027372494125847524, - 0.045834616794996084 - ], - "translation_xyz_cm": [ - -1.9667955088666478, - 2.7372494125847524, - 4.583461679499608 - ], - "translation_norm_m": 0.056893707813636965, - "rotation_rpy_deg_xyz": [ - 0.09546623284033685, - 1.0775827775049782, - -0.28309517022880676 - ], - "rotation_angle_deg": 1.1184574012171737, - "pair_index": 23, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.000680810561117795, - -0.03623345147140078, - -0.05595427497908071 - ], - "translation_xyz_cm": [ - -0.0680810561117795, - -3.623345147140078, - -5.595427497908071 - ], - "translation_norm_m": 0.06666488878701488, - "rotation_rpy_deg_xyz": [ - 0.49268288279378025, - 0.15825199914177118, - -0.08908409912480708 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 24, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.013469928515111196, - 0.01643375152725446, - -0.04702377587971042 - ], - "translation_xyz_cm": [ - -1.3469928515111196, - 1.6433751527254459, - -4.702377587971042 - ], - "translation_norm_m": 0.051601769944905757, - "rotation_rpy_deg_xyz": [ - -0.02108664689711353, - -0.04627392585907875, - 0.07066423048106227 - ], - "rotation_angle_deg": 0.08705258513790355, - "pair_index": 25, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.027899363202186556, - 0.026903034247490853, - -0.07367138796561233 - ], - "translation_xyz_cm": [ - -2.7899363202186556, - 2.6903034247490853, - -7.367138796561233 - ], - "translation_norm_m": 0.08324434589561598, - "rotation_rpy_deg_xyz": [ - 0.2409867669170421, - 0.5093600460816013, - 0.3169410311225238 - ], - "rotation_angle_deg": 0.6459827373704309, - "pair_index": 26, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010939616274875219, - 0.015885292939296303, - -0.03310178794161495 - ], - "translation_xyz_cm": [ - -1.093961627487522, - 1.5885292939296303, - -3.3101787941614953 - ], - "translation_norm_m": 0.038311174622300694, - "rotation_rpy_deg_xyz": [ - 0.3785440778586856, - 0.6159343431432545, - 0.24648916494074977 - ], - "rotation_angle_deg": 0.7631660358041191, - "pair_index": 27, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.017135985512061636, - 0.014004140600095916, - 0.04593979842553299 - ], - "translation_xyz_cm": [ - 1.7135985512061636, - 1.4004140600095916, - 4.593979842553299 - ], - "translation_norm_m": 0.050992382105520866, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435074547, - -0.2850593933606435 - ], - "rotation_angle_deg": 1.4218618784137365, - "pair_index": 28, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007055871333362607, - 0.006861152080546606, - 0.0189587133841662 - ], - "translation_xyz_cm": [ - -0.7055871333362607, - 0.6861152080546606, - 1.8958713384166201 - ], - "translation_norm_m": 0.02136102856438144, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.3960522522859098 - ], - "rotation_angle_deg": 1.3889476012857718, - "pair_index": 29, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014017420625256793, - 0.010008825009426792, - 0.013941540696733937 - ], - "translation_xyz_cm": [ - 1.4017420625256793, - 1.0008825009426792, - 1.3941540696733936 - ], - "translation_norm_m": 0.022159224175349424, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781155 - ], - "rotation_angle_deg": 1.206866980510852, - "pair_index": 30, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0038331907039319546, - 0.02340287336025282, - 0.05614344570681083 - ], - "translation_xyz_cm": [ - -0.38331907039319546, - 2.340287336025282, - 5.614344570681083 - ], - "translation_norm_m": 0.060946487415784324, - "rotation_rpy_deg_xyz": [ - -1.2295910627015747, - -0.5146874739254865, - 0.6115327195593013 - ], - "rotation_angle_deg": 1.4642363140494412, - "pair_index": 31, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.009690735530324623, - 0.004653170314430355, - 0.035294328624991586 - ], - "translation_xyz_cm": [ - 0.9690735530324623, - 0.4653170314430355, - 3.5294328624991587 - ], - "translation_norm_m": 0.036895148491132165, - "rotation_rpy_deg_xyz": [ - -0.31513998336533716, - -0.2141940157510921, - 0.4953590423367678 - ], - "rotation_angle_deg": 0.6244903967618453, - "pair_index": 32, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0053865347058952295, - -0.007425116242552987, - 0.026573012796881706 - ], - "translation_xyz_cm": [ - -0.538653470589523, - -0.7425116242552987, - 2.6573012796881708 - ], - "translation_norm_m": 0.028111778962856066, - "rotation_rpy_deg_xyz": [ - 0.5172047347275823, - -1.243920438445153, - 0.237155447967133 - ], - "rotation_angle_deg": 1.3688430767407762, - "pair_index": 33, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.020732733130354397, - 1.4957174660823469e-05, - 0.028656318943141107 - ], - "translation_xyz_cm": [ - -2.0732733130354397, - 0.001495717466082347, - 2.865631894314111 - ], - "translation_norm_m": 0.03536991747435377, - "rotation_rpy_deg_xyz": [ - -0.6182568414692499, - -1.2732199342731065, - 0.17800383183508972 - ], - "rotation_angle_deg": 1.425676324367976, - "pair_index": 34, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - -0.00010639052652550163, - 0.024898921500229765, - -0.051552206983603015 - ], - "translation_xyz_cm": [ - -0.010639052652550163, - 2.4898921500229765, - -5.155220698360301 - ], - "translation_norm_m": 0.05725030703584904, - "rotation_rpy_deg_xyz": [ - -0.11937661233725184, - -0.6309937842808361, - 0.0919383792671678 - ], - "rotation_angle_deg": 0.6486412679040614, - "pair_index": 35, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00486040978797142, - 0.0002558414003355214, - -0.02124869507791763 - ], - "translation_xyz_cm": [ - -0.48604097879714203, - 0.02558414003355214, - -2.1248695077917628 - ], - "translation_norm_m": 0.021798992652034516, - "rotation_rpy_deg_xyz": [ - 0.11147341198359842, - -0.20435563963405623, - -0.048278644462965606 - ], - "rotation_angle_deg": 0.23769553016909534, - "pair_index": 36, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010668777398309404, - 0.028608197246107858, - -0.02214058432095123 - ], - "translation_xyz_cm": [ - 1.0668777398309404, - 2.860819724610786, - -2.214058432095123 - ], - "translation_norm_m": 0.03771547739218002, - "rotation_rpy_deg_xyz": [ - 1.0522317952095899, - 0.21279800583519293, - -0.14258070238539514 - ], - "rotation_angle_deg": 1.0832171246083169, - "pair_index": 37, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004724714533978824, - 0.005398902444147535, - 0.025142779046231058 - ], - "translation_xyz_cm": [ - 0.47247145339788243, - 0.5398902444147535, - 2.5142779046231056 - ], - "translation_norm_m": 0.026146326954213064, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334274723 - ], - "rotation_angle_deg": 1.2215923174512227, - "pair_index": 38, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.005549632447955588, - "improved_pairs": 13, - "worsened_pairs": 26, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.003543965438597585, - "global_consistency_signal": false - } - } - ] -} diff --git a/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.csv b/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.csv deleted file mode 100644 index 65c2b08..0000000 --- a/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.csv +++ /dev/null @@ -1,19 +0,0 @@ -label,roll_correction_deg,pitch_correction_deg,yaw_correction_deg,selected_pair_translation_cm,selected_pair_rotation_deg,all_pair_translation_rms_m,all_pair_rotation_rms_deg,normalized_global_rms,normalized_global_rms_change,improved_pairs,worsened_pairs,global_consistency_signal,ground_normal_tilt_rms_deg,ground_height_rms_m -baseline,0.0,0.0,0.0,7.9716047501124,0.5471090190705759,0.10039155672864886,1.0152957563636194,2.855641391442648,0.0,0,0,False,1.6662748432297785,0.03471396517121729 -pitch_+0.100,0.0,0.1,0.0,7.877722926634115,0.5242415332114175,0.10031155812336309,1.0345690614552345,2.8820645462820917,0.026423154839443797,27,39,False,1.661255702204205,0.03471396517121729 -pitch_+0.200,0.0,0.2,0.0,7.783902534642328,0.5013877557627758,0.10034501725742666,1.0647782869175946,2.9262023505769332,0.07056095913428528,26,40,False,1.6622470214176333,0.03471396517121729 -pitch_+0.300,0.0,0.3,0.0,7.69014529426882,0.4785497243321324,0.1004916878666913,1.1050268752403856,2.9872678674890754,0.1316264760464274,25,41,False,1.669238092496052,0.034713965171217276 -pitch_+0.000_roll_-0.200,-0.2,0.0,0.0,7.822046878606513,0.5457706857344996,0.10257010426899679,1.0267538544989139,2.9026099336312234,0.04696854218857549,22,44,False,1.7107124278398285,0.034713965171217304 -pitch_+0.000_roll_-0.100,-0.1,0.0,0.0,7.896797905766369,0.545955313109902,0.10143505999644054,1.0151691591975842,2.870174601960012,0.014533210517364115,25,41,False,1.685676496509504,0.034713965171217304 -pitch_+0.000_roll_+0.100,0.1,0.0,0.0,8.046465471725153,0.5492256932471735,0.09944242267101946,1.0271293323765827,2.859282573021794,0.0036411815791459468,38,28,False,1.652705907802981,0.034713965171217304 -pitch_+0.100_roll_-0.200,-0.2,0.1,0.0,7.728092854641688,0.5228446714705329,0.10256719458254226,1.0458160126880083,2.929664876976855,0.07402348553420701,24,42,False,1.7058242505297496,0.034713965171217304 -pitch_+0.100_roll_-0.100,-0.1,0.1,0.0,7.802880223772661,0.5230373912267472,0.10139401948155134,1.0344448200154543,2.896999001946205,0.04135761050355713,31,35,False,1.6807154082401394,0.03471396517121729 -pitch_+0.100_roll_+0.100,0.1,0.1,0.0,7.952619015892104,0.5264501536349752,0.09932272291285332,1.0461846579706375,2.885136161262053,0.029494769819405242,30,36,False,1.6476453039285432,0.0347139651712173 -pitch_+0.200_roll_-0.200,-0.2,0.2,0.0,7.634199171873722,0.49992704876652105,0.10267526429269669,1.0757093910702569,2.9741363007059745,0.11849490926332651,27,39,False,1.7067898021773054,0.034713965171217304 -pitch_+0.200_roll_-0.100,-0.1,0.2,0.0,7.709023440769963,0.5001285987059726,0.10146524807256484,1.0646575627535269,2.9414386837539155,0.08579729231126754,30,36,False,1.6816953294526065,0.03471396517121731 -pitch_+0.200_roll_+0.100,0.1,0.2,0.0,7.8588344993060915,0.5036965847149959,0.09931755660454081,1.0760678191977628,2.928699135454269,0.07305774401162113,29,37,False,1.648644705864238,0.034713965171217304 -pitch_+0.300_roll_-0.200,-0.2,0.3,0.0,7.540367539154748,0.47701910095086286,0.102893833307342,1.1155635852142416,3.035256961724302,0.17961557028165398,25,41,False,1.7135991876939975,0.03471396517121731 -pitch_+0.300_roll_-0.100,-0.1,0.3,0.0,7.615229271779279,0.47723032409407057,0.10164837804314657,1.1049105360171487,3.0027098217989345,0.14706843035628658,25,41,False,1.6886059172123598,0.0347139651712173 -pitch_+0.300_roll_+0.100,0.1,0.3,0.0,7.7651136462045685,0.48096817789925783,0.09942680753866891,1.1159092500059349,2.989195517179804,0.13355412573715597,28,38,False,1.6556931398905776,0.034713965171217304 -yaw_-0.200_diagnostic,0.0,0.0,-0.2,7.9342751812671235,0.5471090190705757,0.10053142254152782,1.0152957563636194,2.8576089058597884,0.0019675144171404924,35,31,False,1.6662748432297787,0.0347139651712173 -yaw_+0.200_diagnostic,0.0,0.0,0.2,8.012589151848083,0.547109019070576,0.10091495789660097,1.0152957563636194,2.8630112438600364,0.007369852417388412,18,48,False,1.6662748432297787,0.0347139651712173 diff --git a/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.json b/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.json deleted file mode 100644 index 760e8d4..0000000 --- a/results/01_previous_two_batches/diagnostics/open3d_refined_pair0_left_rpy_scan.json +++ /dev/null @@ -1,28131 +0,0 @@ -{ - "schema_version": 1, - "diagnostic_only": true, - "extrinsic_was_modified": false, - "equation": "delta_ij = B_ij^-1 * (X^-1 * A_ij * X)", - "correction_convention": "X_test = DeltaR_body * X; DeltaR uses fixed body xyz RPY axes", - "component_frame": "delta translation/RPY components are in station-j LiDAR coordinates, not screen axes", - "selection_rule": "Never accept a correction from selected_pair alone. Require improvement over all refined pairs, directional consistency across pairs, acceptable ground constraints, and independent visual review. This script never overwrites X.", - "pairs_file": "results\\01_previous_two_batches\\open3d_gicp\\B_batch2_refined.npz", - "extrinsic_file": "results\\01_previous_two_batches\\final_extrinsic_recommended.json", - "stations": 38, - "pairs": 66, - "selected_pair_index": 0, - "selected_pair_stations": [ - 0, - 1 - ], - "normalization": { - "translation_scale_m": 0.05, - "rotation_scale_deg": 0.5 - }, - "z_observability": { - "body_left_z_test_shift_m": 0.1, - "max_predicted_motion_change_translation_m": 9.977540720306595e-16, - "max_predicted_motion_change_rotation_deg": 0.0, - "numerically_unobservable": true, - "note": "AX pairs cannot determine X.z when every A rotation preserves body Z; use ground/external height constraints." - }, - "ranking_by_all_pair_normalized_rms": [ - { - "rank": 1, - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.855641391442648, - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 66, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - }, - { - "rank": 2, - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "normalized_global_rms": 2.8576089058597884, - "normalized_global_rms_change": 0.0019675144171404924, - "improved_pairs": 35, - "worsened_pairs": 31, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.0004636456605737749, - "global_consistency_signal": false - }, - { - "rank": 3, - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.859282573021794, - "normalized_global_rms_change": 0.0036411815791459468, - "improved_pairs": 38, - "worsened_pairs": 28, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.014602177580218312, - "global_consistency_signal": false - }, - { - "rank": 4, - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "normalized_global_rms": 2.8630112438600364, - "normalized_global_rms_change": 0.007369852417388412, - "improved_pairs": 18, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.00446840177433383, - "global_consistency_signal": false - }, - { - "rank": 5, - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.870174601960012, - "normalized_global_rms_change": 0.014533210517364115, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.026002343812685902, - "global_consistency_signal": false - }, - { - "rank": 6, - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.8820645462820917, - "normalized_global_rms_change": 0.026423154839443797, - "improved_pairs": 27, - "worsened_pairs": 39, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.009421696072265062, - "global_consistency_signal": false - }, - { - "rank": 7, - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.885136161262053, - "normalized_global_rms_change": 0.029494769819405242, - "improved_pairs": 30, - "worsened_pairs": 36, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.013664187192618082, - "global_consistency_signal": false - }, - { - "rank": 8, - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.896999001946205, - "normalized_global_rms_change": 0.04135761050355713, - "improved_pairs": 31, - "worsened_pairs": 35, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.029706550191235692, - "global_consistency_signal": false - }, - { - "rank": 9, - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "normalized_global_rms": 2.9026099336312234, - "normalized_global_rms_change": 0.04696854218857549, - "improved_pairs": 22, - "worsened_pairs": 44, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.058852162807430775, - "global_consistency_signal": false - }, - { - "rank": 10, - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.9262023505769332, - "normalized_global_rms_change": 0.07056095913428528, - "improved_pairs": 26, - "worsened_pairs": 40, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.032875044386196706, - "global_consistency_signal": false - }, - { - "rank": 11, - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.928699135454269, - "normalized_global_rms_change": 0.07305774401162113, - "improved_pairs": 29, - "worsened_pairs": 37, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.028170056427377133, - "global_consistency_signal": false - }, - { - "rank": 12, - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "normalized_global_rms": 2.929664876976855, - "normalized_global_rms_change": 0.07402348553420701, - "improved_pairs": 24, - "worsened_pairs": 42, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08265109992793152, - "global_consistency_signal": false - }, - { - "rank": 13, - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.9414386837539155, - "normalized_global_rms_change": 0.08579729231126754, - "improved_pairs": 30, - "worsened_pairs": 36, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.04173782588453678, - "global_consistency_signal": false - }, - { - "rank": 14, - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "normalized_global_rms": 2.9741363007059745, - "normalized_global_rms_change": 0.11849490926332651, - "improved_pairs": 27, - "worsened_pairs": 39, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08349931538584737, - "global_consistency_signal": false - }, - { - "rank": 15, - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.9872678674890754, - "normalized_global_rms_change": 0.1316264760464274, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.06946933674042727, - "global_consistency_signal": false - }, - { - "rank": 16, - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 2.989195517179804, - "normalized_global_rms_change": 0.13355412573715597, - "improved_pairs": 28, - "worsened_pairs": 38, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07166839723602836, - "global_consistency_signal": false - }, - { - "rank": 17, - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.0027098217989345, - "normalized_global_rms_change": 0.14706843035628658, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.11484993145673816, - "global_consistency_signal": false - }, - { - "rank": 18, - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.035256961724302, - "normalized_global_rms_change": 0.17961557028165398, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.12394013343025478, - "global_consistency_signal": false - } - ], - "candidates": [ - { - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10039155672864886, - "median": 0.05450403433881216, - "p90": 0.15869974404950557, - "p95": 0.22041418619989872, - "max": 0.33202503466347527 - }, - "rotation_deg": { - "rms": 1.0152957563636194, - "median": 0.824276911032484, - "p90": 1.539611636411223, - "p95": 1.7217363975309565, - "max": 2.1823059901966912 - }, - "normalized_pair_score": { - "rms": 2.855641391442648, - "median": 2.414287031882419, - "p90": 4.4146805323239775, - "p95": 4.909732217219371, - "max": 6.691784409843274 - }, - "normalized_global_rms": 2.855641391442648 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012534527869489276, - 0.014156729744957297, - 0.07744107981697244 - ], - "translation_xyz_cm": [ - -1.2534527869489276, - 1.4156729744957297, - 7.744107981697244 - ], - "translation_norm_m": 0.079716047501124, - "rotation_rpy_deg_xyz": [ - -0.5355339443982136, - -0.10930893417334092, - 0.024668300837138387 - ], - "rotation_angle_deg": 0.5471090190705759, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297785, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012534527869489276, - 0.014156729744957297, - 0.07744107981697244 - ], - "translation_xyz_cm": [ - -1.2534527869489276, - 1.4156729744957297, - 7.744107981697244 - ], - "translation_norm_m": 0.079716047501124, - "rotation_rpy_deg_xyz": [ - -0.5355339443982136, - -0.10930893417334092, - 0.024668300837138387 - ], - "rotation_angle_deg": 0.5471090190705759, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02052857396800767, - -0.01428529034535031, - 0.13304578508256934 - ], - "translation_xyz_cm": [ - 2.052857396800767, - -1.428529034535031, - 13.304578508256935 - ], - "translation_norm_m": 0.1353760421849012, - "rotation_rpy_deg_xyz": [ - -0.3191465214425994, - -0.21122341614483142, - -0.346462756418374 - ], - "rotation_angle_deg": 0.5166365681634405, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03273144680100759, - 0.009583887593645146, - 0.10969579762499791 - ], - "translation_xyz_cm": [ - 3.273144680100759, - 0.9583887593645146, - 10.96957976249979 - ], - "translation_norm_m": 0.11487543918383647, - "rotation_rpy_deg_xyz": [ - -0.2783386301425947, - -0.2946203532968976, - -0.4025139229771167 - ], - "rotation_angle_deg": 0.5717221816616095, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03436110047699936, - -0.018260324601735434, - 0.048397996035787025 - ], - "translation_xyz_cm": [ - 3.436110047699936, - -1.8260324601735434, - 4.839799603578703 - ], - "translation_norm_m": 0.06210064976174764, - "rotation_rpy_deg_xyz": [ - 0.2530123443114437, - 0.07856507161125245, - -0.351501336427272 - ], - "rotation_angle_deg": 0.4402983357286552, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04584216322665169, - 0.012536569398787334, - 0.026379085846845066 - ], - "translation_xyz_cm": [ - 4.584216322665169, - 1.2536569398787334, - 2.6379085846845065 - ], - "translation_norm_m": 0.054355548674489614, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940201 - ], - "rotation_angle_deg": 0.5821611725015269, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.012111902334902142, - 0.010737896559687377, - -0.029461775560652687 - ], - "translation_xyz_cm": [ - 1.211190233490214, - 1.0737896559687377, - -2.9461775560652685 - ], - "translation_norm_m": 0.03361542532652273, - "rotation_rpy_deg_xyz": [ - 0.4935004374697856, - 0.09079480892185002, - 0.12920228121145502 - ], - "rotation_angle_deg": 0.5180525169080186, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.005190953532214183, - 0.021323398506183727, - -0.009506283200473876 - ], - "translation_xyz_cm": [ - 0.5190953532214183, - 2.1323398506183726, - -0.9506283200473876 - ], - "translation_norm_m": 0.02391657882546618, - "rotation_rpy_deg_xyz": [ - 0.2526567759620954, - 0.20523572243396423, - -0.03457860688667861 - ], - "rotation_angle_deg": 0.32738975448002894, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03364854084308805, - 0.0012226941252421741, - -0.070083418794606 - ], - "translation_xyz_cm": [ - -3.3648540843088046, - 0.12226941252421741, - -7.0083418794606 - ], - "translation_norm_m": 0.07775220171630512, - "rotation_rpy_deg_xyz": [ - 0.5232134708787115, - 0.45218792670014574, - 0.5310776539185706 - ], - "rotation_angle_deg": 0.8706732532310371, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.032106401477432905, - -0.015947690198082287, - -0.12726937214731257 - ], - "translation_xyz_cm": [ - -3.2106401477432907, - -1.5947690198082287, - -12.726937214731256 - ], - "translation_norm_m": 0.13222194570212337, - "rotation_rpy_deg_xyz": [ - 0.6042176970972334, - 0.22227025318415516, - 0.39424218871599365 - ], - "rotation_angle_deg": 0.7543101544010229, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03198060915260165, - -0.01947511276020042, - -0.05023979367056203 - ], - "translation_xyz_cm": [ - -3.1980609152601644, - -1.947511276020042, - -5.023979367056203 - ], - "translation_norm_m": 0.06265840922697155, - "rotation_rpy_deg_xyz": [ - 0.44639004529749127, - 0.318991530825338, - 0.5838735792541095 - ], - "rotation_angle_deg": 0.8002960897011372, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03925092882946142, - -0.03685914526653261, - -0.07561323920882028 - ], - "translation_xyz_cm": [ - -3.9250928829461422, - -3.685914526653261, - -7.561323920882028 - ], - "translation_norm_m": 0.09282561040685418, - "rotation_rpy_deg_xyz": [ - 0.5870852895990377, - 0.7143924390784686, - 0.4978279478250872 - ], - "rotation_angle_deg": 1.0484294819479303, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013516950439105994, - -0.009882318425277786, - -0.030135431261166214 - ], - "translation_xyz_cm": [ - -1.3516950439105995, - -0.9882318425277786, - -3.0135431261166215 - ], - "translation_norm_m": 0.034474807960716856, - "rotation_rpy_deg_xyz": [ - 0.3047418481958035, - 0.25845828464587195, - -0.08851206912855099 - ], - "rotation_angle_deg": 0.40941928556312257, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.010196308827790157, - -0.0010884557567257258, - -0.21034014743119353 - ], - "translation_xyz_cm": [ - 1.0196308827790157, - -0.10884557567257258, - -21.034014743119354 - ], - "translation_norm_m": 0.21058995007127537, - "rotation_rpy_deg_xyz": [ - -0.10886326738779815, - -0.05166856778838729, - 0.29112607701138427 - ], - "rotation_angle_deg": 0.31503433509617923, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.008768951212550946, - 0.018957570253404304, - -0.1948915382022732 - ], - "translation_xyz_cm": [ - 0.8768951212550946, - 1.8957570253404303, - -19.48915382022732 - ], - "translation_norm_m": 0.19600764178503086, - "rotation_rpy_deg_xyz": [ - 0.008783200158708619, - -0.22556277911163353, - 0.39543493496896054 - ], - "rotation_angle_deg": 0.4553437938897119, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009233694103114365, - 0.007512315370010292, - -0.13212252727912907 - ], - "translation_xyz_cm": [ - -0.9233694103114365, - 0.7512315370010292, - -13.212252727912906 - ], - "translation_norm_m": 0.1326576729919253, - "rotation_rpy_deg_xyz": [ - 0.41824380852496823, - -0.5183159728890546, - -0.1006787201382111 - ], - "rotation_angle_deg": 0.6733003074377573, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.007613001510299977, - 0.016285228367701632, - -0.13040538568372895 - ], - "translation_xyz_cm": [ - 0.7613001510299977, - 1.6285228367701632, - -13.040538568372895 - ], - "translation_norm_m": 0.13163863821198593, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.2904144812930959 - ], - "rotation_angle_deg": 1.1065820279922887, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.011488538550025573, - -0.0008063144595218397, - -0.05618117646468765 - ], - "translation_xyz_cm": [ - -1.1488538550025573, - -0.08063144595218397, - -5.6181176464687645 - ], - "translation_norm_m": 0.05734946599559085, - "rotation_rpy_deg_xyz": [ - -0.8100617809077635, - 0.1347822057482451, - -0.21350123200693158 - ], - "rotation_angle_deg": 0.8482577323638308, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.008990335888938494, - -0.018511803061524446, - 0.06810618384817382 - ], - "translation_xyz_cm": [ - -0.8990335888938494, - -1.8511803061524446, - 6.810618384817382 - ], - "translation_norm_m": 0.0711474895575793, - "rotation_rpy_deg_xyz": [ - 0.2506843576111674, - -0.39577345967054717, - -0.48572894550815465 - ], - "rotation_angle_deg": 0.6742174925689881, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00046231776291572046, - -0.0010242925377600964, - 0.0014833618698432294 - ], - "translation_xyz_cm": [ - 0.046231776291572046, - -0.10242925377600964, - 0.14833618698432294 - ], - "translation_norm_m": 0.0018609877360485794, - "rotation_rpy_deg_xyz": [ - 0.1196437156776497, - -0.35285794691723626, - -0.4810120163770678 - ], - "rotation_angle_deg": 0.6081452332544832, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.0032926131192255736, - 0.016398189986607137, - -0.06699966090360598 - ], - "translation_xyz_cm": [ - 0.32926131192255736, - 1.6398189986607137, - -6.699966090360599 - ], - "translation_norm_m": 0.06905574919720985, - "rotation_rpy_deg_xyz": [ - -0.7824538874847704, - -0.43842269799839084, - -0.3093948954996394 - ], - "rotation_angle_deg": 0.9497479873876231, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.009947953803371101, - 0.020779243974916817, - -0.06065640872154629 - ], - "translation_xyz_cm": [ - 0.9947953803371101, - 2.0779243974916817, - -6.065640872154629 - ], - "translation_norm_m": 0.06488404028756532, - "rotation_rpy_deg_xyz": [ - 0.05141503904963397, - 0.00449354092149435, - 0.00566257803508252 - ], - "rotation_angle_deg": 0.05192051717362457, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011720839382669546, - 0.04078765655773409, - -0.10661277348598798 - ], - "translation_xyz_cm": [ - 1.1720839382669546, - 4.078765655773409, - -10.661277348598798 - ], - "translation_norm_m": 0.1147488321233841, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.16652151636587426 - ], - "rotation_angle_deg": 0.9937108406424444, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006342328407356823, - 0.017067540552920146, - -0.05076258460687988 - ], - "translation_xyz_cm": [ - 0.6342328407356823, - 1.7067540552920146, - -5.076258460687988 - ], - "translation_norm_m": 0.05392926910429046, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.16495442440099967 - ], - "rotation_angle_deg": 0.9700546737541248, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0029615537252287716, - -0.015602409668654449, - -0.15553629906742833 - ], - "translation_xyz_cm": [ - -0.29615537252287716, - -1.560240966865445, - -15.553629906742833 - ], - "translation_norm_m": 0.15634495935439827, - "rotation_rpy_deg_xyz": [ - -0.5624711770128455, - 1.5874171543552886, - -0.3356941185799336 - ], - "rotation_angle_deg": 1.7157208115256657, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.003791304528554862, - 0.012534187505847671, - -0.03278414830878857 - ], - "translation_xyz_cm": [ - -0.3791304528554862, - 1.2534187505847671, - -3.278414830878857 - ], - "translation_norm_m": 0.03530269432766617, - "rotation_rpy_deg_xyz": [ - 0.5054479062183199, - 0.37053727338806464, - 0.2012151551448648 - ], - "rotation_angle_deg": 0.657726366657615, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.012897038438446362, - 0.021966162546112722, - -0.02486499346186534 - ], - "translation_xyz_cm": [ - 1.2897038438446362, - 2.196616254611272, - -2.486499346186534 - ], - "translation_norm_m": 0.03559654192956971, - "rotation_rpy_deg_xyz": [ - 0.6631716668254954, - 0.8578341641824542, - 0.19039500522722122 - ], - "rotation_angle_deg": 1.1000121074477258, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.009165448104967222, - 0.007156691537795634, - -0.011490603970520298 - ], - "translation_xyz_cm": [ - -0.9165448104967222, - 0.7156691537795634, - -1.14906039705203 - ], - "translation_norm_m": 0.016348016770830025, - "rotation_rpy_deg_xyz": [ - -0.5552161207846, - 2.009421266253433, - 0.6357031086241718 - ], - "rotation_angle_deg": 2.1823059901966912, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015866384253375942, - 0.015300057010963153, - -0.0011746508218896112 - ], - "translation_xyz_cm": [ - 1.5866384253375942, - 1.5300057010963153, - -0.11746508218896112 - ], - "translation_norm_m": 0.022072917758372244, - "rotation_rpy_deg_xyz": [ - 0.31124513246765945, - 0.2668531437532043, - -0.014031036738193812 - ], - "rotation_angle_deg": 0.410245251568496, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.003651031066738808, - 0.009502453304174097, - 0.020648953838683645 - ], - "translation_xyz_cm": [ - -0.3651031066738808, - 0.9502453304174097, - 2.0648953838683646 - ], - "translation_norm_m": 0.02302185790244543, - "rotation_rpy_deg_xyz": [ - -0.0706997048049651, - 1.5418459142259642, - 0.47434907172896096 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.010538481346067052, - 0.009057359696676315, - 0.24603164555939755 - ], - "translation_xyz_cm": [ - 1.0538481346067052, - 0.9057359696676315, - 24.603164555939756 - ], - "translation_norm_m": 0.24642375285353765, - "rotation_rpy_deg_xyz": [ - -0.19311360273658207, - -0.3257197603704734, - -0.29329237395151503 - ], - "rotation_angle_deg": 0.4792997116095301, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0029179808849593147, - -0.00604526747301759, - 0.029773048041171597 - ], - "translation_xyz_cm": [ - 0.2917980884959315, - -0.604526747301759, - 2.9773048041171597 - ], - "translation_norm_m": 0.030520390903905938, - "rotation_rpy_deg_xyz": [ - 0.1988255972381051, - 1.3268006810040451, - 0.5142543825749734 - ], - "rotation_angle_deg": 1.4359692367424095, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0311981451842821, - -0.006193419626776775, - 0.2308292473188145 - ], - "translation_xyz_cm": [ - 3.11981451842821, - -0.6193419626776775, - 23.082924731881448 - ], - "translation_norm_m": 0.2330103519747209, - "rotation_rpy_deg_xyz": [ - 0.16034369761383055, - -0.5134999386071942, - -0.25259308482191567 - ], - "rotation_angle_deg": 0.5939965715201481, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.029001881766678617, - 0.007519462479232075, - 0.3306704888273173 - ], - "translation_xyz_cm": [ - 2.9001881766678617, - 0.7519462479232075, - 33.06704888273173 - ], - "translation_norm_m": 0.33202503466347527, - "rotation_rpy_deg_xyz": [ - -0.2563013940830722, - 0.22672202245265619, - -0.2325405141945881 - ], - "rotation_angle_deg": 0.41343957554542377, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00730364189944277, - 0.013670158850596081, - 0.16030703291232581 - ], - "translation_xyz_cm": [ - 0.730364189944277, - 1.3670158850596081, - 16.03070329123258 - ], - "translation_norm_m": 0.16105452874461287, - "rotation_rpy_deg_xyz": [ - 0.8856777756756924, - -1.4812056342085482, - -0.7441413425210681 - ], - "rotation_angle_deg": 1.874838081135504, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.01280809400838745, - 0.02652544478208263, - 0.22174104630547103 - ], - "translation_xyz_cm": [ - -1.280809400838745, - 2.652544478208263, - 22.174104630547102 - ], - "translation_norm_m": 0.2236889315761065, - "rotation_rpy_deg_xyz": [ - 0.7326830017201678, - -0.4714411171372534, - -0.699149025175759 - ], - "rotation_angle_deg": 1.1151964340680336, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002695148636261191, - -0.01128426159720508, - 0.11210802984096663 - ], - "translation_xyz_cm": [ - 0.2695148636261191, - -1.128426159720508, - 11.210802984096663 - ], - "translation_norm_m": 0.11270673777901995, - "rotation_rpy_deg_xyz": [ - -0.7185342597651662, - 0.6180768996940113, - 0.004530359058899453 - ], - "rotation_angle_deg": 0.9478191646739258, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -6.348802272287957e-05, - -0.0034095380069181225, - -0.04076756342947927 - ], - "translation_xyz_cm": [ - -0.006348802272287957, - -0.34095380069181225, - -4.076756342947927 - ], - "translation_norm_m": 0.04090994021171706, - "rotation_rpy_deg_xyz": [ - -0.5190787323237711, - 0.5728926682292592, - 0.08970289125554098 - ], - "rotation_angle_deg": 0.7785618518380144, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0007618573013186136, - 0.027582229992488383, - 0.04717560921479383 - ], - "translation_xyz_cm": [ - -0.07618573013186136, - 2.7582229992488383, - 4.717560921479383 - ], - "translation_norm_m": 0.054652520003134704, - "rotation_rpy_deg_xyz": [ - -0.8380523330945311, - -0.11317732429063847, - -0.7401789685624974 - ], - "rotation_angle_deg": 1.124375763416717, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01339014355257051, - -0.04001543383677619, - -0.016954210012467465 - ], - "translation_xyz_cm": [ - 1.339014355257051, - -4.001543383677619, - -1.6954210012467466 - ], - "translation_norm_m": 0.04547500551567543, - "rotation_rpy_deg_xyz": [ - 0.10326906176616622, - 0.025313967913603432, - -0.6469944518488355 - ], - "rotation_angle_deg": 0.6556954445211121, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0022291303581982724, - 0.014081419404674111, - 0.0015919215957723165 - ], - "translation_xyz_cm": [ - 0.22291303581982724, - 1.4081419404674111, - 0.15919215957723165 - ], - "translation_norm_m": 0.014345368903282344, - "rotation_rpy_deg_xyz": [ - -0.11264639000956125, - 0.09867563901568227, - 0.14236359183674263 - ], - "rotation_angle_deg": 0.20669080105969403, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.006825491191319699, - -0.011833827708358113, - -0.020754327235084163 - ], - "translation_xyz_cm": [ - 0.6825491191319699, - -1.1833827708358113, - -2.0754327235084165 - ], - "translation_norm_m": 0.02484690940972022, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.1511766857359274 - ], - "rotation_angle_deg": 1.7237415928660533, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.003984245475547654, - 0.004381143887356165, - 0.056523486089229115 - ], - "translation_xyz_cm": [ - 0.3984245475547654, - 0.4381143887356165, - 5.652348608922911 - ], - "translation_norm_m": 0.056832852413462566, - "rotation_rpy_deg_xyz": [ - -0.355025584566797, - -0.4408120377458715, - -0.13900903227030575 - ], - "rotation_angle_deg": 0.5831473606925555, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01300263115987299, - -0.029342601752106012, - 0.023854081683098563 - ], - "translation_xyz_cm": [ - -1.300263115987299, - -2.9342601752106012, - 2.3854081683098562 - ], - "translation_norm_m": 0.03998842216950218, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.21201038202913366 - ], - "rotation_angle_deg": 1.124691549503354, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012279637037453606, - 0.02195120021718555, - 0.04576807245005926 - ], - "translation_xyz_cm": [ - -1.2279637037453606, - 2.195120021718555, - 4.576807245005926 - ], - "translation_norm_m": 0.052224143195848054, - "rotation_rpy_deg_xyz": [ - 0.09546623284033692, - 1.0775827775049782, - -0.28309517022880915 - ], - "rotation_angle_deg": 1.1184574012171749, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.001743350970683899, - -0.02928001457804441, - -0.05581878949693109 - ], - "translation_xyz_cm": [ - -0.1743350970683899, - -2.928001457804441, - -5.581878949693109 - ], - "translation_norm_m": 0.06305629062353875, - "rotation_rpy_deg_xyz": [ - 0.49268288279378014, - 0.15825199914177118, - -0.08908409912480704 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012077454792722264, - 0.0096471919343597, - -0.11944510558989167 - ], - "translation_xyz_cm": [ - 1.2077454792722264, - 0.96471919343597, - -11.944510558989167 - ], - "translation_norm_m": 0.12044113282375335, - "rotation_rpy_deg_xyz": [ - 0.12223918632624674, - 0.5394939332637073, - -0.032189371067825975 - ], - "rotation_angle_deg": 0.5541382586948841, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0004428196504786541, - 0.022527315211353205, - -0.11946808940704962 - ], - "translation_xyz_cm": [ - -0.04428196504786541, - 2.2527315211353205, - -11.946808940704962 - ], - "translation_norm_m": 0.12157425881511807, - "rotation_rpy_deg_xyz": [ - 0.027649317399596487, - 0.9049016731683907, - 0.21555739065093388 - ], - "rotation_angle_deg": 0.9305812158627094, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.02099922653299524, - 0.019606439549219146, - -0.04714541806544017 - ], - "translation_xyz_cm": [ - -2.099922653299524, - 1.9606439549219146, - -4.714541806544017 - ], - "translation_norm_m": 0.0552093328283033, - "rotation_rpy_deg_xyz": [ - -0.02108664689711338, - -0.04627392585907875, - 0.07066423048105945 - ], - "rotation_angle_deg": 0.08705258513790126, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03486321758831146, - 0.023776982101818334, - -0.07381118183894142 - ], - "translation_xyz_cm": [ - -3.4863217588311457, - 2.3776982101818334, - -7.3811181838941415 - ], - "translation_norm_m": 0.08502281683725502, - "rotation_rpy_deg_xyz": [ - 0.24098676691704204, - 0.5093600460816013, - 0.31694103112252414 - ], - "rotation_angle_deg": 0.6459827373704314, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009825755543722281, - 0.013969499096951665, - -0.0331294671365258 - ], - "translation_xyz_cm": [ - -0.9825755543722281, - 1.3969499096951665, - -3.31294671365258 - ], - "translation_norm_m": 0.03727269737723399, - "rotation_rpy_deg_xyz": [ - 0.3785440778586856, - 0.6159343431432545, - 0.24648916494074977 - ], - "rotation_angle_deg": 0.7631660358041192, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.004985497717641341, - 0.0014594738069999558, - 0.04513930055527167 - ], - "translation_xyz_cm": [ - 0.49854977176413406, - 0.14594738069999558, - 4.513930055527167 - ], - "translation_norm_m": 0.04543722819346571, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435074547, - -0.2850593933606419 - ], - "rotation_angle_deg": 1.4218618784137362, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.014310358103192033, - 0.009631176068884084, - 0.01891573218756422 - ], - "translation_xyz_cm": [ - -1.4310358103192033, - 0.9631176068884084, - 1.8915732187564218 - ], - "translation_norm_m": 0.02559982081388642, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.39605225228591057 - ], - "rotation_angle_deg": 1.388947601285772, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.018381059682074596, - 0.020336843343690347, - 0.08005232267565662 - ], - "translation_xyz_cm": [ - 1.8381059682074596, - 2.0336843343690347, - 8.005232267565662 - ], - "translation_norm_m": 0.08461574864048203, - "rotation_rpy_deg_xyz": [ - 1.9153211457929256, - -0.5642927668743174, - -0.512933641877203 - ], - "rotation_angle_deg": 2.0591868076103896, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0018274394122426152, - 0.011798997822643376, - 0.02652868110836 - ], - "translation_xyz_cm": [ - 0.18274394122426152, - 1.1798997822643376, - 2.652868110836 - ], - "translation_norm_m": 0.029091696509025003, - "rotation_rpy_deg_xyz": [ - 1.6796519267758923, - 0.14604200808447562, - 0.18829326127872345 - ], - "rotation_angle_deg": 1.6962319982758776, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.004926721987130733, - 0.01081300665837337, - 0.013881092504425818 - ], - "translation_xyz_cm": [ - 0.49267219871307333, - 1.081300665837337, - 1.3881092504425818 - ], - "translation_norm_m": 0.01827234061769129, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781172 - ], - "rotation_angle_deg": 1.206866980510853, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0009736907280213369, - -0.015151928607180787, - 0.008068360402694846 - ], - "translation_xyz_cm": [ - -0.0973690728021337, - -1.5151928607180787, - 0.8068360402694846 - ], - "translation_norm_m": 0.017193820219448392, - "rotation_rpy_deg_xyz": [ - -0.7428475785243822, - -0.3000926755847766, - -0.6995398700125933 - ], - "rotation_angle_deg": 1.0648693173338315, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004800114846089443, - 0.039402542738807944, - 0.05599536375195781 - ], - "translation_xyz_cm": [ - -0.48001148460894427, - 3.9402542738807944, - 5.599536375195781 - ], - "translation_norm_m": 0.06863732394647468, - "rotation_rpy_deg_xyz": [ - -1.2295910627015743, - -0.5146874739254865, - 0.6115327195592978 - ], - "rotation_angle_deg": 1.4642363140494394, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.022455666341073766, - 0.022205356741625604, - 0.03575689440074663 - ], - "translation_xyz_cm": [ - 2.2455666341073766, - 2.2205356741625604, - 3.5756894400746626 - ], - "translation_norm_m": 0.04770629220585725, - "rotation_rpy_deg_xyz": [ - -0.31513998336533705, - -0.2141940157510921, - 0.4953590423367671 - ], - "rotation_angle_deg": 0.6244903967618446, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.008739514143986105, - -0.026187277750069515, - 0.018829535871696022 - ], - "translation_xyz_cm": [ - -0.8739514143986105, - -2.6187277750069518, - 1.8829535871696021 - ], - "translation_norm_m": 0.03341712202712415, - "rotation_rpy_deg_xyz": [ - 0.837061807032181, - -0.6739925190910833, - -0.12485818713744098 - ], - "rotation_angle_deg": 1.0813371239331708, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003821333082424605, - -0.0008422271162171202, - 0.026790673598253614 - ], - "translation_xyz_cm": [ - -0.3821333082424605, - -0.08422271162171202, - 2.6790673598253614 - ], - "translation_norm_m": 0.027074935362624366, - "rotation_rpy_deg_xyz": [ - 0.5172047347275824, - -1.243920438445153, - 0.23715544796713608 - ], - "rotation_angle_deg": 1.3688430767407767, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015134357633463047, - 0.004972583641746908, - 0.028913453889094512 - ], - "translation_xyz_cm": [ - -1.5134357633463047, - 0.4972583641746908, - 2.891345388909451 - ], - "translation_norm_m": 0.03301156138156032, - "rotation_rpy_deg_xyz": [ - -0.6182568414692501, - -1.2732199342731065, - 0.17800383183508953 - ], - "rotation_angle_deg": 1.4256763243679755, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0061062182666129505, - 0.01602768262860832, - -0.0514569961191151 - ], - "translation_xyz_cm": [ - 0.610621826661295, - 1.602768262860832, - -5.1456996119115095 - ], - "translation_norm_m": 0.054240160043693975, - "rotation_rpy_deg_xyz": [ - -0.11937661233725202, - -0.6309937842808361, - 0.09193837926716737 - ], - "rotation_angle_deg": 0.6486412679040612, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0053080710713586665, - 0.002196157177062119, - -0.02122936871520257 - ], - "translation_xyz_cm": [ - -0.5308071071358667, - 0.2196157177062119, - -2.122936871520257 - ], - "translation_norm_m": 0.021992835671895014, - "rotation_rpy_deg_xyz": [ - 0.11147341198359811, - -0.20435563963405623, - -0.04827864446295879 - ], - "rotation_angle_deg": 0.23769553016909395, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010102197262432444, - 0.020309199742545747, - -0.022416274937106278 - ], - "translation_xyz_cm": [ - 1.0102197262432444, - 2.0309199742545747, - -2.2416274937106277 - ], - "translation_norm_m": 0.031890552923517286, - "rotation_rpy_deg_xyz": [ - 1.0522317952095894, - 0.21279800583519293, - -0.14258070238539475 - ], - "rotation_angle_deg": 1.0832171246083164, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015027572179813209, - 0.011197336920040102, - -0.023743342149443684 - ], - "translation_xyz_cm": [ - 1.502757217981321, - 1.1197336920040102, - -2.3743342149443682 - ], - "translation_norm_m": 0.030248216082042558, - "rotation_rpy_deg_xyz": [ - 0.9676191955684414, - 0.24244576185523073, - -0.07892468324294744 - ], - "rotation_angle_deg": 1.000808453258414, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003715628797124282, - 0.0013204687437722296, - 0.02497676781930607 - ], - "translation_xyz_cm": [ - 0.3715628797124282, - 0.13204687437722296, - 2.497676781930607 - ], - "translation_norm_m": 0.025286131886091672, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334271742 - ], - "rotation_angle_deg": 1.2215923174512224, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 66, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152209554813, - -6.733076264476427e-05, - 0.7182317203430111 - ], - "rotation_rpy_deg_xyz": [ - -0.7866097110824058, - 1.3026501895476275, - -0.8355419388029673 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10031155812336309, - "median": 0.053814157932401845, - "p90": 0.1588433408203973, - "p95": 0.21512888213768822, - "max": 0.33160790555284764 - }, - "rotation_deg": { - "rms": 1.0345690614552345, - "median": 0.8395764537322474, - "p90": 1.5978584404386378, - "p95": 1.7822076684057468, - "max": 2.298723808499413 - }, - "normalized_pair_score": { - "rms": 2.8820645462820917, - "median": 2.4145393767177072, - "p90": 4.611329206308679, - "p95": 4.867755654721635, - "max": 6.706343277488829 - }, - "normalized_global_rms": 2.8820645462820917 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012609168802931114, - 0.013841271683855627, - 0.0765198007783251 - ], - "translation_xyz_cm": [ - -1.2609168802931114, - 1.3841271683855627, - 7.65198007783251 - ], - "translation_norm_m": 0.07877722926634115, - "rotation_rpy_deg_xyz": [ - -0.512749062712626, - -0.10633713822578715, - 0.025180128279355885 - ], - "rotation_angle_deg": 0.5242415332114175, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.661255702204205, - "median": 0.7319328700150243, - "p90": 2.3218554814672183, - "p95": 3.880978501442499, - "max": 5.5539133452469 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012609168802931114, - 0.013841271683855627, - 0.0765198007783251 - ], - "translation_xyz_cm": [ - -1.2609168802931114, - 1.3841271683855627, - 7.65198007783251 - ], - "translation_norm_m": 0.07877722926634115, - "rotation_rpy_deg_xyz": [ - -0.512749062712626, - -0.10633713822578715, - 0.025180128279355885 - ], - "rotation_angle_deg": 0.5242415332114175, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02051966594073562, - -0.014923276025446741, - 0.13078527843056897 - ], - "translation_xyz_cm": [ - 2.051966594073562, - -1.4923276025446741, - 13.078527843056897 - ], - "translation_norm_m": 0.13322368374959653, - "rotation_rpy_deg_xyz": [ - -0.27499964252311604, - -0.20023069659911333, - -0.3454035114939882 - ], - "rotation_angle_deg": 0.4851311566747633, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03295136881139227, - 0.008617322556370821, - 0.1071756913550131 - ], - "translation_xyz_cm": [ - 3.2951368811392268, - 0.8617322556370821, - 10.71756913550131 - ], - "translation_norm_m": 0.11245745760957769, - "rotation_rpy_deg_xyz": [ - -0.21216311907327182, - -0.26828285027110155, - -0.400818110870366 - ], - "rotation_angle_deg": 0.5272965606703562, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034337379664961976, - -0.018542182852037237, - 0.0471252642060859 - ], - "translation_xyz_cm": [ - 3.4337379664961976, - -1.8542182852037237, - 4.71252642060859 - ], - "translation_norm_m": 0.06118544527636886, - "rotation_rpy_deg_xyz": [ - 0.27564597154663273, - 0.0814914904988837, - -0.35095270635227116 - ], - "rotation_angle_deg": 0.4537914571352452, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04594209861596066, - 0.011921598454077476, - 0.024908745166160175 - ], - "translation_xyz_cm": [ - 4.594209861596066, - 1.1921598454077476, - 2.4908745166160173 - ], - "translation_norm_m": 0.053602672701010205, - "rotation_rpy_deg_xyz": [ - 0.4075306811169571, - 0.2594733494501883, - -0.3833101993023162 - ], - "rotation_angle_deg": 0.6172849060984689, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.012738151358421573, - 0.009707202404908744, - -0.03132620936945348 - ], - "translation_xyz_cm": [ - 1.2738151358421574, - 0.9707202404908744, - -3.132620936945348 - ], - "translation_norm_m": 0.03518268994859203, - "rotation_rpy_deg_xyz": [ - 0.5773527078393991, - 0.1385783703347208, - 0.13213833670522987 - ], - "rotation_angle_deg": 0.6081248354534395, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00523573679978292, - 0.02098993006877678, - -0.009625001957190535 - ], - "translation_xyz_cm": [ - 0.523573679978292, - 2.098993006877678, - -0.9625001957190534 - ], - "translation_norm_m": 0.02367764276283985, - "rotation_rpy_deg_xyz": [ - 0.2792119562023699, - 0.20921882814903586, - -0.033924760434783256 - ], - "rotation_angle_deg": 0.3505955247931428, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03321621732171365, - 0.00040588091060411724, - -0.07059760975127063 - ], - "translation_xyz_cm": [ - -3.321621732171365, - 0.040588091060411724, - -7.059760975127063 - ], - "translation_norm_m": 0.07802246045254921, - "rotation_rpy_deg_xyz": [ - 0.5930310698175939, - 0.481990798394924, - 0.5333036360882121 - ], - "rotation_angle_deg": 0.9304552261138788, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03134603786983453, - -0.0169527610905027, - -0.1281079006265316 - ], - "translation_xyz_cm": [ - -3.134603786983453, - -1.69527610905027, - -12.81079006265316 - ], - "translation_norm_m": 0.13297219409209604, - "rotation_rpy_deg_xyz": [ - 0.6924803660825333, - 0.2780464876427371, - 0.39756898189109063 - ], - "rotation_angle_deg": 0.8447252815494993, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03174089547398258, - -0.02004014194491016, - -0.050603077140599535 - ], - "translation_xyz_cm": [ - -3.174089547398258, - -2.004014194491016, - -5.060307714059953 - ], - "translation_norm_m": 0.0630060564609459, - "rotation_rpy_deg_xyz": [ - 0.49496347730467044, - 0.3323723766499313, - 0.5852293196132937 - ], - "rotation_angle_deg": 0.8344276259149954, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038754942189076574, - -0.037690113430767724, - -0.07623097682966877 - ], - "translation_xyz_cm": [ - -3.8754942189076576, - -3.769011343076772, - -7.623097682966877 - ], - "translation_norm_m": 0.0934540102023894, - "rotation_rpy_deg_xyz": [ - 0.6603821300742498, - 0.7478965916725878, - 0.5002551436195283 - ], - "rotation_angle_deg": 1.114174265455696, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013423979465021843, - -0.010267484351008827, - -0.030196651376784105 - ], - "translation_xyz_cm": [ - -1.3423979465021842, - -1.0267484351008827, - -3.0196651376784107 - ], - "translation_norm_m": 0.034604366977978036, - "rotation_rpy_deg_xyz": [ - 0.336131850082815, - 0.2639837018538619, - -0.08771892131972028 - ], - "rotation_angle_deg": 0.4364656210971346, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011250593987533863, - -0.0019109942727930235, - -0.2106173559714391 - ], - "translation_xyz_cm": [ - 1.1250593987533863, - -0.19109942727930235, - -21.06173559714391 - ], - "translation_norm_m": 0.21092628665148133, - "rotation_rpy_deg_xyz": [ - -0.013305642112808764, - 0.024135510269224773, - 0.29417474379451547 - ], - "rotation_angle_deg": 0.2954657171488672, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.009561571934055046, - 0.018228379804984197, - -0.19541728745831702 - ], - "translation_xyz_cm": [ - 0.9561571934055046, - 1.8228379804984196, - -19.5417287458317 - ], - "translation_norm_m": 0.19649838097483494, - "rotation_rpy_deg_xyz": [ - 0.09180364768394243, - -0.17906995381581534, - 0.39792926220929115 - ], - "rotation_angle_deg": 0.4460444594815879, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.008029823406353387, - 0.0065225204070428755, - -0.13252025582315163 - ], - "translation_xyz_cm": [ - -0.8029823406353387, - 0.6522520407042876, - -13.252025582315163 - ], - "translation_norm_m": 0.1329234348782451, - "rotation_rpy_deg_xyz": [ - 0.5165422252836472, - -0.42448116378973205, - -0.09647502483751788 - ], - "rotation_angle_deg": 0.6752310994879848, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.007969648944450514, - 0.01586724522081695, - -0.133300045644409 - ], - "translation_xyz_cm": [ - 0.7969648944450514, - 1.586724522081695, - -13.3300045644409 - ], - "translation_norm_m": 0.13447745886949547, - "rotation_rpy_deg_xyz": [ - -0.7990426814538194, - 0.6665122976755382, - 0.29130516749756297 - ], - "rotation_angle_deg": 1.0817877508079645, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.010876383609927376, - -0.0017151879517438573, - -0.05793220094121644 - ], - "translation_xyz_cm": [ - -1.0876383609927376, - -0.17151879517438573, - -5.7932200941216445 - ], - "translation_norm_m": 0.05896929282290558, - "rotation_rpy_deg_xyz": [ - -0.7306818258803741, - 0.17592477144513233, - -0.21175443543652553 - ], - "rotation_angle_deg": 0.7805185815376894, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.008980912710379041, - -0.01920360690398721, - 0.06976846062768055 - ], - "translation_xyz_cm": [ - -0.8980912710379041, - -1.920360690398721, - 6.976846062768055 - ], - "translation_norm_m": 0.07291826526728762, - "rotation_rpy_deg_xyz": [ - 0.2987019064790666, - -0.38269733969455455, - -0.48443649743174 - ], - "rotation_angle_deg": 0.6851208317935833, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0007753480461729634, - -0.0018746231610113906, - 0.0021012096647769346 - ], - "translation_xyz_cm": [ - 0.07753480461729634, - -0.18746231610113906, - 0.21012096647769346 - ], - "translation_norm_m": 0.002920694890579392, - "rotation_rpy_deg_xyz": [ - 0.18635037892170195, - -0.3260387051895817, - -0.4791133906880013 - ], - "rotation_angle_deg": 0.6083324473724265, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.003970167583140505, - 0.015421170959264097, - -0.067727176624028 - ], - "translation_xyz_cm": [ - 0.3970167583140505, - 1.5421170959264097, - -6.772717662402799 - ], - "translation_norm_m": 0.06957402674745335, - "rotation_rpy_deg_xyz": [ - -0.6981460464478615, - -0.38980011390765934, - -0.3075123549405965 - ], - "rotation_angle_deg": 0.8575389520162001, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010117055046520385, - 0.020530943807697155, - -0.06146207983047336 - ], - "translation_xyz_cm": [ - 1.0117055046520385, - 2.0530943807697155, - -6.146207983047336 - ], - "translation_norm_m": 0.0655855297572309, - "rotation_rpy_deg_xyz": [ - 0.07441835191959958, - 0.007514475391252907, - 0.006210389018937291 - ], - "rotation_angle_deg": 0.0750537590458637, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01212909412596097, - 0.04027826130641543, - -0.10853949724003133 - ], - "translation_xyz_cm": [ - 1.212909412596097, - 4.027826130641543, - -10.853949724003133 - ], - "translation_norm_m": 0.11640565157801863, - "rotation_rpy_deg_xyz": [ - -0.9050550997692758, - -0.21062912431314335, - 0.16755718166353725 - ], - "rotation_angle_deg": 0.9439310075445936, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006513283956986249, - 0.016746887839297453, - -0.051679826017548475 - ], - "translation_xyz_cm": [ - 0.6513283956986249, - 1.6746887839297453, - -5.167982601754847 - ], - "translation_norm_m": 0.05471458249324784, - "rotation_rpy_deg_xyz": [ - -0.9242360847641867, - -0.08473452237526666, - 0.16554781300183535 - ], - "rotation_angle_deg": 0.9426406124065511, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.002517289967038927, - -0.016172505331196962, - -0.159918582817198 - ], - "translation_xyz_cm": [ - -0.2517289967038927, - -1.6172505331196962, - -15.9918582817198 - ], - "translation_norm_m": 0.16075397291428528, - "rotation_rpy_deg_xyz": [ - -0.502675724876127, - 1.6083371465480425, - -0.3342944122427632 - ], - "rotation_angle_deg": 1.716520406845749, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.003648777943310977, - 0.01214323738835521, - -0.03389703392487266 - ], - "translation_xyz_cm": [ - -0.3648777943310977, - 1.214323738835521, - -3.3897033924872657 - ], - "translation_norm_m": 0.03619089255121388, - "rotation_rpy_deg_xyz": [ - 0.5398851760199954, - 0.37717311314485535, - 0.20211984111247944 - ], - "rotation_angle_deg": 0.6883808183046061, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.013282352266933195, - 0.02128041577101114, - -0.028883766458077387 - ], - "translation_xyz_cm": [ - 1.3282352266933195, - 2.128041577101114, - -2.888376645807739 - ], - "translation_norm_m": 0.03825635818964949, - "rotation_rpy_deg_xyz": [ - 0.7286253667397738, - 0.8834478731029967, - 0.1924888369877166 - ], - "rotation_angle_deg": 1.1602813065616997, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.00737876383761682, - 0.006072468853074664, - -0.016940253254376907 - ], - "translation_xyz_cm": [ - -0.737876383761682, - 0.6072468853074664, - -1.6940253254376907 - ], - "translation_norm_m": 0.01944976128556109, - "rotation_rpy_deg_xyz": [ - -0.46790975957555336, - 2.1555948607173834, - 0.638311705555451 - ], - "rotation_angle_deg": 2.298723808499413, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016008219006262037, - 0.014910060465881614, - -0.0040908251799821466 - ], - "translation_xyz_cm": [ - 1.6008219006262037, - 1.4910060465881614, - -0.40908251799821466 - ], - "translation_norm_m": 0.02225551233968499, - "rotation_rpy_deg_xyz": [ - 0.3468947442821179, - 0.273967507351442, - -0.013112983496972798 - ], - "rotation_angle_deg": 0.4422529024425402, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.002237634641799824, - 0.008254025600278325, - 0.01694195478575204 - ], - "translation_xyz_cm": [ - -0.22376346417998239, - 0.8254025600278325, - 1.6941954785752038 - ], - "translation_norm_m": 0.018978034127978036, - "rotation_rpy_deg_xyz": [ - 0.027107288441695736, - 1.65452244628629, - 0.4779898666505666 - ], - "rotation_angle_deg": 1.7222843995877888, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.012997038881888745, - 0.00785730061288259, - 0.2425978873914294 - ], - "translation_xyz_cm": [ - 1.2997038881888745, - 0.785730061288259, - 24.25978873914294 - ], - "translation_norm_m": 0.24307281863549282, - "rotation_rpy_deg_xyz": [ - -0.1202705986595927, - -0.15886553919277463, - -0.28986674736185397 - ], - "rotation_angle_deg": 0.3518843244021867, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.003868188830824515, - -0.007321599704367077, - 0.029744250367459223 - ], - "translation_xyz_cm": [ - 0.3868188830824515, - -0.7321599704367077, - 2.9744250367459224 - ], - "translation_norm_m": 0.030875380758526715, - "rotation_rpy_deg_xyz": [ - 0.29460764614638735, - 1.4031611071505918, - 0.5177246451530397 - ], - "rotation_angle_deg": 1.52313489934156, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.033085430211094224, - -0.00772591694151048, - 0.2295864749218431 - ], - "translation_xyz_cm": [ - 3.3085430211094224, - -0.772591694151048, - 22.95864749218431 - ], - "translation_norm_m": 0.23208680477760554, - "rotation_rpy_deg_xyz": [ - 0.252165863350938, - -0.3776720919769801, - -0.24823185418507174 - ], - "rotation_angle_deg": 0.5171360805623124, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0316080871535942, - 0.006256412044179704, - 0.33003876917715375 - ], - "translation_xyz_cm": [ - 3.16080871535942, - 0.6256412044179704, - 33.003876917715374 - ], - "translation_norm_m": 0.33160790555284764, - "rotation_rpy_deg_xyz": [ - -0.1889207162566587, - 0.39922394183375987, - -0.22937149602151732 - ], - "rotation_angle_deg": 0.49737283436600194, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.007447834058094571, - 0.012883577645579347, - 0.1562255365269482 - ], - "translation_xyz_cm": [ - 0.7447834058094571, - 1.2883577645579347, - 15.62255365269482 - ], - "translation_norm_m": 0.15693270872650933, - "rotation_rpy_deg_xyz": [ - 0.9422424393989156, - -1.4626641073905104, - -0.7423520859628502 - ], - "rotation_angle_deg": 1.886888108853824, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012219975766302404, - 0.02518037496651271, - 0.21471318630795244 - ], - "translation_xyz_cm": [ - -1.2219975766302404, - 2.518037496651271, - 21.471318630795245 - ], - "translation_norm_m": 0.21652974729975716, - "rotation_rpy_deg_xyz": [ - 0.8186168933082603, - -0.4200459673784277, - -0.6958675384757913 - ], - "rotation_angle_deg": 1.1517874172683882, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002699720339027989, - -0.011896602276093349, - 0.10889477737808648 - ], - "translation_xyz_cm": [ - 0.2699720339027989, - -1.1896602276093349, - 10.889477737808647 - ], - "translation_norm_m": 0.10957595619408267, - "rotation_rpy_deg_xyz": [ - -0.6756869326612127, - 0.6284153173251659, - 0.005483126304856047 - ], - "rotation_angle_deg": 0.9227809946255764, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00039028101324112274, - -0.004244709256594703, - -0.04487265144198564 - ], - "translation_xyz_cm": [ - 0.039028101324112274, - -0.4244709256594703, - -4.487265144198564 - ], - "translation_norm_m": 0.04507465721862179, - "rotation_rpy_deg_xyz": [ - -0.4487972006148934, - 0.6032064639501636, - 0.09139918033367782 - ], - "rotation_angle_deg": 0.7576679009812031, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.00041424810922041644, - 0.026864782968873957, - 0.04098611416278038 - ], - "translation_xyz_cm": [ - -0.041424810922041644, - 2.6864782968873957, - 4.098611416278038 - ], - "translation_norm_m": 0.049007649603150315, - "rotation_rpy_deg_xyz": [ - -0.7823419582087989, - -0.09522388778360807, - -0.7389683499726251 - ], - "rotation_angle_deg": 1.0808111897380877, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013863041074912097, - -0.04097294278766839, - -0.016259471775116358 - ], - "translation_xyz_cm": [ - 1.3863041074912097, - -4.097294278766839, - -1.6259471775116356 - ], - "translation_norm_m": 0.04620969996583025, - "rotation_rpy_deg_xyz": [ - 0.18029387575019123, - 0.06332105940999891, - -0.6446945932449862 - ], - "rotation_angle_deg": 0.6725136623168326, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0025186370511449674, - 0.013162731270232264, - 0.0034530882763703086 - ], - "translation_xyz_cm": [ - 0.25186370511449674, - 1.3162731270232264, - 0.34530882763703086 - ], - "translation_norm_m": 0.013839250186775169, - "rotation_rpy_deg_xyz": [ - -0.04403478488052194, - 0.1273110235892916, - 0.14421755524377414 - ], - "rotation_angle_deg": 0.19738278257018982, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.006773453670679608, - -0.012432659839920202, - -0.014361138260317763 - ], - "translation_xyz_cm": [ - 0.6773453670679608, - -1.2432659839920202, - -1.4361138260317763 - ], - "translation_norm_m": 0.020166630790887465, - "rotation_rpy_deg_xyz": [ - -1.3165597183166375, - -1.022088859606694, - 0.15217388298814216 - ], - "rotation_angle_deg": 1.6725819815357155, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.004880349390126826, - 0.003049741772324935, - 0.05732746794052886 - ], - "translation_xyz_cm": [ - 0.4880349390126826, - 0.3049741772324935, - 5.732746794052886 - ], - "translation_norm_m": 0.057615599584834136, - "rotation_rpy_deg_xyz": [ - -0.25947399506936814, - -0.36494574516350675, - -0.13628532271320348 - ], - "rotation_angle_deg": 0.4683062669355568, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.010314327084092856, - -0.0294789375686772, - 0.01867830279389164 - ], - "translation_xyz_cm": [ - -1.0314327084092856, - -2.94789375686772, - 1.8678302793891641 - ], - "translation_norm_m": 0.036390549578646375, - "rotation_rpy_deg_xyz": [ - 1.0767619755284152, - -0.13234391573093487, - -0.20515862979025176 - ], - "rotation_angle_deg": 1.1038610850821526, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012007348585915345, - 0.02108765803839452, - 0.0406260959681395 - ], - "translation_xyz_cm": [ - -1.2007348585915345, - 2.108765803839452, - 4.06260959681395 - ], - "translation_norm_m": 0.047321722445621404, - "rotation_rpy_deg_xyz": [ - 0.1636261283576874, - 1.1057380728049826, - -0.28115514026609795 - ], - "rotation_angle_deg": 1.1529800073040937, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004303917880057462, - -0.030431288495687103, - -0.0576385471772721 - ], - "translation_xyz_cm": [ - -0.04303917880057462, - -3.0431288495687103, - -5.7638547177272095 - ], - "translation_norm_m": 0.06518014020624337, - "rotation_rpy_deg_xyz": [ - 0.5911935925908259, - 0.26035862854617775, - -0.08456304865131221 - ], - "rotation_angle_deg": 0.6516700744745407, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01440890545290685, - 0.00931052305084723, - -0.12337531407999634 - ], - "translation_xyz_cm": [ - 1.440890545290685, - 0.931052305084723, - -12.337531407999634 - ], - "translation_norm_m": 0.12456231581087801, - "rotation_rpy_deg_xyz": [ - 0.1582048779792953, - 0.7321926634568835, - -0.028288571199334922 - ], - "rotation_angle_deg": 0.7496612320663737, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0019033469090001809, - 0.022771112012406114, - -0.12252147313126147 - ], - "translation_xyz_cm": [ - 0.1903346909000181, - 2.2771112012406114, - -12.252147313126146 - ], - "translation_norm_m": 0.12463409505425059, - "rotation_rpy_deg_xyz": [ - 0.01028268790533792, - 1.1035957977074127, - 0.21796833579600192 - ], - "rotation_angle_deg": 1.1249422078458442, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.020244558201732987, - 0.01851393698804904, - -0.04443072341892369 - ], - "translation_xyz_cm": [ - -2.0244558201732987, - 1.851393698804904, - -4.443072341892369 - ], - "translation_norm_m": 0.05221778608012503, - "rotation_rpy_deg_xyz": [ - 0.06990196894477091, - 0.015609813596195071, - 0.07352927378554952 - ], - "rotation_angle_deg": 0.10264065763694455, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03344177297623341, - 0.022657094817768342, - -0.07271034569665377 - ], - "translation_xyz_cm": [ - -3.344177297623341, - 2.265709481776834, - -7.271034569665377 - ], - "translation_norm_m": 0.08317746387515178, - "rotation_rpy_deg_xyz": [ - 0.338381643721089, - 0.6245163780718037, - 0.3212323512722692 - ], - "rotation_angle_deg": 0.7787976666017864, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009598209236728883, - 0.013365669792407497, - -0.03457396615463748 - ], - "translation_xyz_cm": [ - -0.9598209236728883, - 1.3365669792407497, - -3.457396615463748 - ], - "translation_norm_m": 0.03829002331174167, - "rotation_rpy_deg_xyz": [ - 0.43003972350458614, - 0.6310663681198572, - 0.24792955123508 - ], - "rotation_angle_deg": 0.8021663667768609, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0067942052548271015, - 0.00019725215510701943, - 0.050179257447018455 - ], - "translation_xyz_cm": [ - 0.6794205254827101, - 0.019725215510701943, - 5.017925744701845 - ], - "translation_norm_m": 0.050637515849334194, - "rotation_rpy_deg_xyz": [ - 1.4268409924314462, - -0.214567689883574, - -0.2774144397796576 - ], - "rotation_angle_deg": 1.4688037653678097, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011945132246371948, - 0.009100958460405595, - 0.01562431254980888 - ], - "translation_xyz_cm": [ - -1.1945132246371948, - 0.9100958460405595, - 1.562431254980888 - ], - "translation_norm_m": 0.02167101224990329, - "rotation_rpy_deg_xyz": [ - 1.384509151500671, - 0.22140376968280798, - 0.4040854758953925 - ], - "rotation_angle_deg": 1.4584230793826463, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.019509886827240308, - 0.018804223501678763, - 0.08490711768358682 - ], - "translation_xyz_cm": [ - 1.9509886827240308, - 1.8804223501678763, - 8.49071176835868 - ], - "translation_norm_m": 0.08912605196488439, - "rotation_rpy_deg_xyz": [ - 2.013734759024271, - -0.46165425251799913, - -0.5058467181486842 - ], - "rotation_angle_deg": 2.125059053716131, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.003624177304839993, - 0.010656709762927985, - 0.02693673763954188 - ], - "translation_xyz_cm": [ - 0.3624177304839993, - 1.0656709762927985, - 2.693673763954188 - ], - "translation_norm_m": 0.029193971274386672, - "rotation_rpy_deg_xyz": [ - 1.768510774934586, - 0.2887582444117546, - 0.1964935155239931 - ], - "rotation_angle_deg": 1.8021820913450661, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.007262290145911621, - 0.010105120729610118, - 0.012114259065773028 - ], - "translation_xyz_cm": [ - 0.7262290145911621, - 1.0105120729610118, - 1.2114259065773028 - ], - "translation_norm_m": 0.017366910946857106, - "rotation_rpy_deg_xyz": [ - 0.9035135934762457, - 0.8741098204206807, - -0.4974323568110727 - ], - "rotation_angle_deg": 1.354501617940593, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0008936507976333719, - -0.01578941586048721, - 0.009812496459197434 - ], - "translation_xyz_cm": [ - -0.08936507976333719, - -1.578941586048721, - 0.9812496459197434 - ], - "translation_norm_m": 0.018611538134320815, - "rotation_rpy_deg_xyz": [ - -0.6939896225388991, - -0.28651377174004, - -0.6984553955759323 - ], - "rotation_angle_deg": 1.0266292377274089, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004910158924756658, - 0.04010014182667543, - 0.06254041177546328 - ], - "translation_xyz_cm": [ - -0.4910158924756658, - 4.010014182667543, - 6.254041177546328 - ], - "translation_norm_m": 0.07445424192234018, - "rotation_rpy_deg_xyz": [ - -1.2786779623618896, - -0.5026242861886394, - 0.6103604643866053 - ], - "rotation_angle_deg": 1.5011041162059429, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02314757907141196, - 0.02343298995790466, - 0.04282352956059339 - ], - "translation_xyz_cm": [ - 2.314757907141196, - 2.343298995790466, - 4.282352956059339 - ], - "translation_norm_m": 0.054025643163793484, - "rotation_rpy_deg_xyz": [ - -0.41234774915652744, - -0.14294196684435448, - 0.49375825121481526 - ], - "rotation_angle_deg": 0.6585978079878347, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.008452182388582141, - -0.025359385798184197, - 0.020955090868092198 - ], - "translation_xyz_cm": [ - -0.8452182388582141, - -2.5359385798184197, - 2.0955090868092197 - ], - "translation_norm_m": 0.03396547759830569, - "rotation_rpy_deg_xyz": [ - 0.7661662151354478, - -0.645907480166912, - -0.12563091140113153 - ], - "rotation_angle_deg": 1.009405050223996, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003674432424048746, - -0.0001118141021488328, - 0.029407677492396075 - ], - "translation_xyz_cm": [ - -0.3674432424048746, - -0.01118141021488328, - 2.9407677492396074 - ], - "translation_norm_m": 0.029636555999797257, - "rotation_rpy_deg_xyz": [ - 0.45451664837675126, - -1.222941734881918, - 0.23624942935701784 - ], - "rotation_angle_deg": 1.3267506740417352, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01396027436975622, - 0.006222939178173126, - 0.029651784943137027 - ], - "translation_xyz_cm": [ - -1.396027436975622, - 0.6222939178173126, - 2.9651784943137027 - ], - "translation_norm_m": 0.03335929529843462, - "rotation_rpy_deg_xyz": [ - -0.7195756743216479, - -1.1770200306448997, - 0.17598332254564697 - ], - "rotation_angle_deg": 1.3897893060956639, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007893373743384391, - 0.0170801559921141, - -0.0499133514293227 - ], - "translation_xyz_cm": [ - 0.7893373743384391, - 1.7080155992114099, - -4.99133514293227 - ], - "translation_norm_m": 0.053342100902333905, - "rotation_rpy_deg_xyz": [ - -0.2082641615943626, - -0.48249627837492387, - 0.09160682521358601 - ], - "rotation_angle_deg": 0.5332986524627087, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00484721201223981, - 0.003150703424940282, - -0.02155231831609281 - ], - "translation_xyz_cm": [ - -0.484721201223981, - 0.3150703424940282, - -2.155231831609281 - ], - "translation_norm_m": 0.022314229118697376, - "rotation_rpy_deg_xyz": [ - 0.0343272360026619, - -0.1696745516127692, - -0.04944597788558324 - ], - "rotation_angle_deg": 0.1800213546372699, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011210970051067193, - 0.021594279532552108, - -0.025233683986500333 - ], - "translation_xyz_cm": [ - 1.1210970051067193, - 2.1594279532552108, - -2.5233683986500335 - ], - "translation_norm_m": 0.03505335312843106, - "rotation_rpy_deg_xyz": [ - 0.9522016451020995, - 0.2961266316996025, - -0.14216772784271955 - ], - "rotation_angle_deg": 1.0076148796229685, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015316661565448975, - 0.011983946168473536, - -0.028735720009444018 - ], - "translation_xyz_cm": [ - 1.5316661565448975, - 1.1983946168473536, - -2.8735720009444017 - ], - "translation_norm_m": 0.034698079078538835, - "rotation_rpy_deg_xyz": [ - 0.9156445983698082, - 0.2561662438043904, - -0.07964782915709098 - ], - "rotation_angle_deg": 0.9543031339490973, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00386251604912613, - 0.001949884093898735, - 0.022715246811351883 - ], - "translation_xyz_cm": [ - 0.386251604912613, - 0.1949884093898735, - 2.271524681135188 - ], - "translation_norm_m": 0.023123657061763135, - "rotation_rpy_deg_xyz": [ - 1.1702100166322438, - -0.13126702440410526, - 0.021263078443348474 - ], - "rotation_angle_deg": 1.1777652672084904, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.026423154839443797, - "improved_pairs": 27, - "worsened_pairs": 39, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.009421696072265062, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667926374616, - -6.733076264476427e-05, - 0.7159634183009542 - ], - "rotation_rpy_deg_xyz": [ - -0.7880683915167217, - 1.4026395561702687, - -0.8355763723005772 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10034501725742666, - "median": 0.055697729327154805, - "p90": 0.15898854863264478, - "p95": 0.21079766080483558, - "max": 0.331207470731766 - }, - "rotation_deg": { - "rms": 1.0647782869175946, - "median": 0.8967460716753088, - "p90": 1.6183146917955624, - "p95": 1.8843913234187912, - "max": 2.4215601589816793 - }, - "normalized_pair_score": { - "rms": 2.9262023505769332, - "median": 2.4303877464949624, - "p90": 4.746616499294305, - "p95": 4.827948416637867, - "max": 6.741578230650725 - }, - "normalized_global_rms": 2.9262023505769332 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012682365579619326, - 0.013527106101724917, - 0.0755982067955232 - ], - "translation_xyz_cm": [ - -1.2682365579619326, - 1.3527106101724917, - 7.55982067955232 - ], - "translation_norm_m": 0.07783902534642329, - "rotation_rpy_deg_xyz": [ - -0.48996513547728743, - -0.10336574439144892, - 0.02573297644700039 - ], - "rotation_angle_deg": 0.5013877557627758, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6622470214176333, - "median": 0.7148339614213655, - "p90": 2.277662858258894, - "p95": 3.7960285397867324, - "max": 5.579952273463167 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012682365579619326, - 0.013527106101724917, - 0.0755982067955232 - ], - "translation_xyz_cm": [ - -1.2682365579619326, - 1.3527106101724917, - 7.55982067955232 - ], - "translation_norm_m": 0.07783902534642329, - "rotation_rpy_deg_xyz": [ - -0.48996513547728743, - -0.10336574439144892, - 0.02573297644700039 - ], - "rotation_angle_deg": 0.5013877557627758, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02051386609078487, - -0.015557731269103314, - 0.12852403755941622 - ], - "translation_xyz_cm": [ - 2.051386609078487, - -1.5557731269103314, - 12.852403755941621 - ], - "translation_norm_m": 0.13107741962217032, - "rotation_rpy_deg_xyz": [ - -0.23085461037466334, - -0.1892395167107833, - -0.34425847295643264 - ], - "rotation_angle_deg": 0.45594025406310634, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03317356173120256, - 0.007656347154861409, - 0.10465418458912298 - ], - "translation_xyz_cm": [ - 3.317356173120256, - 0.7656347154861409, - 10.465418458912298 - ], - "translation_norm_m": 0.11005272918789379, - "rotation_rpy_deg_xyz": [ - -0.14599012279428614, - -0.24194855514443686, - -0.39897572135183684 - ], - "rotation_angle_deg": 0.48916199208322036, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034315702266682124, - -0.018822621239843296, - 0.04585233573735856 - ], - "translation_xyz_cm": [ - 3.4315702266682124, - -1.8822621239843296, - 4.585233573735856 - ], - "translation_norm_m": 0.06028511578296604, - "rotation_rpy_deg_xyz": [ - 0.29827878592034196, - 0.08441695101341982, - -0.3503633556539259 - ], - "rotation_angle_deg": 0.46797926816769986, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04604377855535169, - 0.01130976188872379, - 0.02343780378703015 - ], - "translation_xyz_cm": [ - 4.604377855535169, - 1.130976188872379, - 2.343780378703015 - ], - "translation_norm_m": 0.05288923240124797, - "rotation_rpy_deg_xyz": [ - 0.4551234260787949, - 0.2722961805773567, - -0.3819135203806907 - ], - "rotation_angle_deg": 0.654190424558848, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.013364222315790236, - 0.00868263345837983, - -0.03319258590825695 - ], - "translation_xyz_cm": [ - 1.3364222315790237, - 0.8682633458379829, - -3.319258590825695 - ], - "translation_norm_m": 0.036820351996626276, - "rotation_rpy_deg_xyz": [ - 0.6612046882037641, - 0.1863539638422574, - 0.13529182076589147 - ], - "rotation_angle_deg": 0.6999512541629207, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.005280556020637331, - 0.020657570998644598, - -0.009743870388128897 - ], - "translation_xyz_cm": [ - 0.528055602063733, - 2.06575709986446, - -0.9743870388128897 - ], - "translation_norm_m": 0.023442749872653306, - "rotation_rpy_deg_xyz": [ - 0.30576630385284326, - 0.21320075582506187, - -0.033222636548297234 - ], - "rotation_angle_deg": 0.37428468642621304, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03278447612247977, - -0.0004075247415502581, - -0.07111288041521424 - ], - "translation_xyz_cm": [ - -3.278447612247977, - -0.04075247415502581, - -7.111288041521425 - ], - "translation_norm_m": 0.078307277516135, - "rotation_rpy_deg_xyz": [ - 0.6628484170307424, - 0.5117879098996975, - 0.5356884781929347 - ], - "rotation_angle_deg": 0.9925106000585615, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030587239744333194, - -0.017952998311270618, - -0.1289485689814081 - ], - "translation_xyz_cm": [ - -3.0587239744333194, - -1.7952998311270618, - -12.89485689814081 - ], - "translation_norm_m": 0.13373714078704826, - "rotation_rpy_deg_xyz": [ - 0.7807440275220056, - 0.33381339962222356, - 0.40113708113642316 - ], - "rotation_angle_deg": 0.9381227254964095, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.031501191670756615, - -0.02060293004202665, - -0.05096674515342746 - ], - "translation_xyz_cm": [ - -3.1501191670756614, - -2.060293004202665, - -5.0966745153427455 - ], - "translation_norm_m": 0.0633594106232753, - "rotation_rpy_deg_xyz": [ - 0.5435358614810986, - 0.3457501290985925, - 0.5866814782604906 - ], - "rotation_angle_deg": 0.8701957998948366, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03825960448656847, - -0.03851737131448241, - -0.07684988476774919 - ], - "translation_xyz_cm": [ - -3.825960448656847, - -3.8517371314482407, - -7.684988476774919 - ], - "translation_norm_m": 0.09409192323075712, - "rotation_rpy_deg_xyz": [ - 0.7336797523092549, - 0.7813942795317939, - 0.5028538998862719 - ], - "rotation_angle_deg": 1.1818112556504974, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013331130956475284, - -0.01065137270259911, - -0.030258028438431173 - ], - "translation_xyz_cm": [ - -1.3331130956475286, - -1.065137270259911, - -3.0258028438431173 - ], - "translation_norm_m": 0.034737862312026004, - "rotation_rpy_deg_xyz": [ - 0.3675209494419985, - 0.26950759267802527, - -0.08686784275218122 - ], - "rotation_angle_deg": 0.4641140983090535, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012302037328588311, - -0.0027292373647943985, - -0.21089716408598155 - ], - "translation_xyz_cm": [ - 1.2302037328588311, - -0.27292373647943985, - -21.089716408598154 - ], - "translation_norm_m": 0.21127328907965814, - "rotation_rpy_deg_xyz": [ - 0.08225250003520912, - 0.09993198100360763, - 0.2975185061727483 - ], - "rotation_angle_deg": 0.3243862122980659, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0103528582378134, - 0.01750327685205136, - -0.1959443704241829 - ], - "translation_xyz_cm": [ - 1.03528582378134, - 1.7503276852051362, - -19.59443704241829 - ], - "translation_norm_m": 0.1969968087944097, - "rotation_rpy_deg_xyz": [ - 0.17482221691416916, - -0.13258313678518835, - 0.4006370077454075 - ], - "rotation_angle_deg": 0.4569605802146475, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.006829506489425596, - 0.005537426352794417, - -0.1329216163200256 - ], - "translation_xyz_cm": [ - -0.6829506489425596, - 0.5537426352794417, - -13.29216163200256 - ], - "translation_norm_m": 0.13321209154813923, - "rotation_rpy_deg_xyz": [ - 0.6148413626939241, - -0.330657810725991, - -0.09193645042424012 - ], - "rotation_angle_deg": 0.7039101000425022, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008330483302982028, - 0.015453053161794794, - -0.13619464976703227 - ], - "translation_xyz_cm": [ - 0.8330483302982028, - 1.5453053161794794, - -13.619464976703227 - ], - "translation_norm_m": 0.13732143470429917, - "rotation_rpy_deg_xyz": [ - -0.7580488375823727, - 0.6759597444083112, - 0.2922743826800189 - ], - "rotation_angle_deg": 1.0581062857341232, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.010263994948455812, - -0.002618431717090308, - -0.05968477175212722 - ], - "translation_xyz_cm": [ - -1.0263994948455812, - -0.2618431717090308, - -5.968477175212722 - ], - "translation_norm_m": 0.06061747071647343, - "rotation_rpy_deg_xyz": [ - -0.6513031160828601, - 0.21706464469076792, - -0.2098110703003792 - ], - "rotation_angle_deg": 0.7175059305402306, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.008974518521137176, - -0.019894914609074735, - 0.07142991078392724 - ], - "translation_xyz_cm": [ - -0.8974518521137176, - -1.9894914609074734, - 7.142991078392724 - ], - "translation_norm_m": 0.07468990403386802, - "rotation_rpy_deg_xyz": [ - 0.3467172126125137, - -0.3696239364566564, - -0.48304896266677344 - ], - "rotation_angle_deg": 0.6993486925105833, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0010865704909703844, - -0.0027230188507425535, - 0.0027179065495190613 - ], - "translation_xyz_cm": [ - 0.10865704909703844, - -0.27230188507425535, - 0.27179065495190613 - ], - "translation_norm_m": 0.003997809788529906, - "rotation_rpy_deg_xyz": [ - 0.2530544584417354, - -0.29922374883802605, - -0.47706645034059303 - ], - "rotation_angle_deg": 0.6168730042301562, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.004646548074314194, - 0.01444861703004141, - -0.06845662240203496 - ], - "translation_xyz_cm": [ - 0.4646548074314194, - 1.444861703004141, - -6.845662240203495 - ], - "translation_norm_m": 0.07011891395181838, - "rotation_rpy_deg_xyz": [ - -0.613841385056918, - -0.34118069066432005, - -0.3054098915767 - ], - "rotation_angle_deg": 0.766547312406537, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010287397036085333, - 0.020283896309429283, - -0.06226761744117501 - ], - "translation_xyz_cm": [ - 1.0287397036085333, - 2.0283896309429283, - -6.226761744117501 - ], - "translation_norm_m": 0.06629119978602181, - "rotation_rpy_deg_xyz": [ - 0.09742078560760371, - 0.010534577213690796, - 0.006799628393851377 - ], - "rotation_angle_deg": 0.09822372370385068, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012539725072939212, - 0.039772513627569506, - -0.11046635370708617 - ], - "translation_xyz_cm": [ - 1.2539725072939212, - 3.9772513627569506, - -11.046635370708618 - ], - "translation_norm_m": 0.11807587749620654, - "rotation_rpy_deg_xyz": [ - -0.8561370947705013, - -0.197011797657047, - 0.16869019740490312 - ], - "rotation_angle_deg": 0.8942834455537132, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006685602606380736, - 0.01642780265446897, - -0.052597037760116344 - ], - "translation_xyz_cm": [ - 0.6685602606380736, - 1.642780265446897, - -5.2597037760116345 - ], - "translation_norm_m": 0.05550692176119774, - "rotation_rpy_deg_xyz": [ - -0.8965756924992224, - -0.08040776004941842, - 0.16619167435301652 - ], - "rotation_angle_deg": 0.9152722241962895, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0020677743987209674, - -0.016735587357972648, - -0.16430127043628787 - ], - "translation_xyz_cm": [ - -0.20677743987209674, - -1.6735587357972648, - -16.430127043628787 - ], - "translation_norm_m": 0.1651643516082043, - "rotation_rpy_deg_xyz": [ - -0.44287856582421825, - 1.6292550930173253, - -0.3327679964047989 - ], - "rotation_angle_deg": 1.7196325575524312, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0035047174526341984, - 0.011754351383962636, - -0.035010040102369334 - ], - "translation_xyz_cm": [ - -0.35047174526341984, - 1.1754351383962636, - -3.5010040102369335 - ], - "translation_norm_m": 0.03709650561508418, - "rotation_rpy_deg_xyz": [ - 0.574321606930612, - 0.38380699496220927, - 0.2030887566625491 - ], - "rotation_angle_deg": 0.7194547264665011, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.013671828760827065, - 0.020601966796989002, - -0.032903316488853085 - ], - "translation_xyz_cm": [ - 1.3671828760827065, - 2.0601966796989, - -3.2903316488853083 - ], - "translation_norm_m": 0.0411580875835509, - "rotation_rpy_deg_xyz": [ - 0.7940796450470556, - 0.9090560718678283, - 0.1947267395326293 - ], - "rotation_angle_deg": 1.22163658987227, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005602457199958, - 0.005000009075184941, - -0.022396093001888755 - ], - "translation_xyz_cm": [ - -0.5602457199958, - 0.5000009075184941, - -2.2396093001888757 - ], - "translation_norm_m": 0.023621443630281014, - "rotation_rpy_deg_xyz": [ - -0.38058554701358294, - 2.301763326684716, - 0.6412995061505258 - ], - "rotation_angle_deg": 2.4215601589816793, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016154493425299066, - 0.014523361680525815, - -0.007007139078745617 - ], - "translation_xyz_cm": [ - 1.6154493425299066, - 1.4523361680525815, - -0.7007139078745617 - ], - "translation_norm_m": 0.022825330017335572, - "rotation_rpy_deg_xyz": [ - 0.3825433750080434, - 0.2810800448344892, - -0.01212812882938608 - ], - "rotation_angle_deg": 0.4748841785598439, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0008296286350282234, - 0.0070158673086409, - 0.0132301208348873 - ], - "translation_xyz_cm": [ - -0.08296286350282234, - 0.70158673086409, - 1.32301208348873 - ], - "translation_norm_m": 0.014998225730740083, - "rotation_rpy_deg_xyz": [ - 0.12492842538259899, - 1.7671899909217683, - 0.4819967397813876 - ], - "rotation_angle_deg": 1.8354867077719332, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015445168553994582, - 0.006664795073338059, - 0.23915596267493672 - ], - "translation_xyz_cm": [ - 1.5445168553994582, - 0.6664795073338059, - 23.915596267493672 - ], - "translation_norm_m": 0.2397468398290301, - "rotation_rpy_deg_xyz": [ - -0.04742105885934263, - 0.007982580276588502, - -0.28609763093761614 - ], - "rotation_angle_deg": 0.29010763147106794, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.004815336084856403, - -0.00859409848940007, - 0.029712099218683376 - ], - "translation_xyz_cm": [ - 0.4815336084856403, - -0.859409848940007, - 2.9712099218683377 - ], - "translation_norm_m": 0.031302632963322974, - "rotation_rpy_deg_xyz": [ - 0.39039794149149243, - 1.4795122974746726, - 0.5214916853415011 - ], - "rotation_angle_deg": 1.6149424078147105, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03496676207083993, - -0.009252557031327546, - 0.22833700890754582 - ], - "translation_xyz_cm": [ - 3.496676207083993, - -0.9252557031327546, - 22.83370089075458 - ], - "translation_norm_m": 0.2311840693001604, - "rotation_rpy_deg_xyz": [ - 0.34399258199885535, - -0.24185450898088387, - -0.24348928201794912 - ], - "rotation_angle_deg": 0.4855486904235825, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.034206775419699964, - 0.004996946508438516, - 0.32939841485579685 - ], - "translation_xyz_cm": [ - 3.4206775419699964, - 0.49969465084385156, - 32.939841485579684 - ], - "translation_norm_m": 0.331207470731766, - "rotation_rpy_deg_xyz": [ - -0.12153051791747407, - 0.5717206711162837, - -0.2258775842610844 - ], - "rotation_angle_deg": 0.626402740369628, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0075971953497935285, - 0.012103320434420306, - 0.15214311516639803 - ], - "translation_xyz_cm": [ - 0.7597195349793529, - 1.2103320434420306, - 15.214311516639803 - ], - "translation_norm_m": 0.15281274565708527, - "rotation_rpy_deg_xyz": [ - 0.9988024432843634, - -1.4441273991216572, - -0.740445285093439 - ], - "rotation_angle_deg": 1.900692861967744, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011627702039361587, - 0.023849425576336625, - 0.2076827467065669 - ], - "translation_xyz_cm": [ - -1.1627702039361587, - 2.3849425576336625, - 20.768274670656687 - ], - "translation_norm_m": 0.20937077598036793, - "rotation_rpy_deg_xyz": [ - 0.9045487157526158, - -0.36866014915602674, - -0.6923577331820522 - ], - "rotation_angle_deg": 1.1955893292198465, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002708917095128882, - -0.012504761856138469, - 0.10568084971072175 - ], - "translation_xyz_cm": [ - 0.2708917095128882, - -1.2504761856138469, - 10.568084971072174 - ], - "translation_norm_m": 0.10645256829446237, - "rotation_rpy_deg_xyz": [ - -0.6328402244243664, - 0.6387528463251688, - 0.006518649598445436 - ], - "rotation_angle_deg": 0.8992086977969045, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0008478451143869026, - -0.005071945899447261, - -0.04897886756205033 - ], - "translation_xyz_cm": [ - 0.08478451143869026, - -0.5071945899447261, - -4.897886756205033 - ], - "translation_norm_m": 0.04924807553809363, - "rotation_rpy_deg_xyz": [ - -0.3785158442391572, - 0.6335173530627393, - 0.09325605860399434 - ], - "rotation_angle_deg": 0.7441128221767888, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -5.835267488141227e-05, - 0.02615561952146961, - 0.03479603674555261 - ], - "translation_xyz_cm": [ - -0.005835267488141227, - 2.615561952146961, - 3.479603674555261 - ], - "translation_norm_m": 0.04353026545731596, - "rotation_rpy_deg_xyz": [ - -0.7266335985293833, - -0.07727169162304574, - -0.7376425947964552 - ], - "rotation_angle_deg": 1.0386526423879934, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01433373545276373, - -0.04192830953837956, - -0.01556630273227179 - ], - "translation_xyz_cm": [ - 1.433373545276373, - -4.192830953837956, - -1.556630273227179 - ], - "translation_norm_m": 0.046965401025954395, - "rotation_rpy_deg_xyz": [ - 0.2573174046262459, - 0.1013226492809947, - -0.6422082803134666 - ], - "rotation_angle_deg": 0.699429350358039, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0028047128639587804, - 0.01224448533551814, - 0.005312893513304551 - ], - "translation_xyz_cm": [ - 0.28047128639587804, - 1.224448533551814, - 0.5312893513304551 - ], - "translation_norm_m": 0.013638939579919261, - "rotation_rpy_deg_xyz": [ - 0.02457539011290846, - 0.15594253429507085, - 0.14622625674217873 - ], - "rotation_angle_deg": 0.2151612126102672, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.006711463774185411, - -0.013035474629375043, - -0.007968978244607544 - ], - "translation_xyz_cm": [ - 0.6711463774185411, - -1.3035474629375043, - -0.7968978244607544 - ], - "translation_norm_m": 0.016687479110647954, - "rotation_rpy_deg_xyz": [ - -1.2639058382075403, - -1.006161602217825, - 0.1532780551103129 - ], - "rotation_angle_deg": 1.6216869757764145, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.005773227423529592, - 0.0017208279484272893, - 0.05812789768815708 - ], - "translation_xyz_cm": [ - 0.5773227423529592, - 0.17208279484272893, - 5.8127897688157075 - ], - "translation_norm_m": 0.05843923248432289, - "rotation_rpy_deg_xyz": [ - -0.16392432056566494, - -0.2890857930613764, - -0.1332664112772747 - ], - "rotation_angle_deg": 0.35820640723283, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00764248094436315, - -0.02961191284776543, - 0.013493456578567473 - ], - "translation_xyz_cm": [ - -0.764248094436315, - -2.961191284776543, - 1.3493456578567473 - ], - "translation_norm_m": 0.03342672984194378, - "rotation_rpy_deg_xyz": [ - 1.0986809047374615, - 0.06474960473127431, - -0.19818831549834356 - ], - "rotation_angle_deg": 1.1183986708695166, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011729696331109096, - 0.020233035848181924, - 0.03548287409515656 - ], - "translation_xyz_cm": [ - -1.1729696331109096, - 2.0233035848181924, - 3.5482874095156562 - ], - "translation_norm_m": 0.0424970101266734, - "rotation_rpy_deg_xyz": [ - 0.23178724983308435, - 1.1338889861351882, - -0.2790619883899568 - ], - "rotation_angle_deg": 1.1910419124051095, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008785451085047136, - -0.031575382693120324, - -0.05946253553295919 - ], - "translation_xyz_cm": [ - 0.08785451085047136, - -3.1575382693120324, - -5.946253553295919 - ], - "translation_norm_m": 0.06733178867171964, - "rotation_rpy_deg_xyz": [ - 0.6897102935200486, - 0.36245298825657307, - -0.07969197330181722 - ], - "rotation_angle_deg": 0.7834342911514396, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.016726418292004386, - 0.008978000583867551, - -0.12731375877838064 - ], - "translation_xyz_cm": [ - 1.6726418292004386, - 0.8978000583867551, - -12.731375877838063 - ], - "translation_norm_m": 0.1287212909259487, - "rotation_rpy_deg_xyz": [ - 0.1941848801480679, - 0.9248877709535336, - -0.024199017023091768 - ], - "rotation_angle_deg": 0.9454024386776976, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.004236397675239978, - 0.02301343672745837, - -0.12558334339780494 - ], - "translation_xyz_cm": [ - 0.4236397675239978, - 2.301343672745837, - -12.558334339780494 - ], - "translation_norm_m": 0.12774482954015207, - "rotation_rpy_deg_xyz": [ - -0.007076799125807535, - 1.3022909920027583, - 0.2202938882837633 - ], - "rotation_angle_deg": 1.320823473828822, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019494084105463605, - 0.0174206923525968, - -0.041718620390635695 - ], - "translation_xyz_cm": [ - -1.9494084105463605, - 1.74206923525968, - -4.171862039063569 - ], - "translation_norm_m": 0.04923355689418222, - "rotation_rpy_deg_xyz": [ - 0.1608902426319585, - 0.0774864007301993, - 0.07665293067706427 - ], - "rotation_angle_deg": 0.19429049612714216, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.032024548399142594, - 0.02153922873078018, - -0.07161429467303898 - ], - "translation_xyz_cm": [ - -3.2024548399142594, - 2.153922873078018, - -7.161429467303898 - ], - "translation_norm_m": 0.08135181175611735, - "rotation_rpy_deg_xyz": [ - 0.4357856033315988, - 0.7396617090725047, - 0.32589232997747175 - ], - "rotation_angle_deg": 0.9172656763444422, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009369146371038528, - 0.01276522110402889, - -0.0360189669818308 - ], - "translation_xyz_cm": [ - -0.9369146371038528, - 1.276522110402889, - -3.60189669818308 - ], - "translation_norm_m": 0.039345873430321844, - "rotation_rpy_deg_xyz": [ - 0.48153485495200554, - 0.6461951362403606, - 0.2494737503758602 - ], - "rotation_angle_deg": 0.8428064910261277, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.008601729267732727, - -0.0010688130452694011, - 0.055212285302563044 - ], - "translation_xyz_cm": [ - 0.8601729267732727, - -0.10688130452694011, - 5.5212285302563044 - ], - "translation_norm_m": 0.05588853689311187, - "rotation_rpy_deg_xyz": [ - 1.509414468898218, - -0.06063052683615484, - -0.26939977027597933 - ], - "rotation_angle_deg": 1.5343238302231954, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.009591881833361349, - 0.008576276121390114, - 0.0123248942831823 - ], - "translation_xyz_cm": [ - -0.9591881833361349, - 0.8576276121390114, - 1.23248942831823 - ], - "translation_norm_m": 0.017817399594416507, - "rotation_rpy_deg_xyz": [ - 1.438170545926305, - 0.40466716336577563, - 0.412388573587803 - ], - "rotation_angle_deg": 1.5485306931722174, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.020634992834133392, - 0.017267244892522182, - 0.0897570490893428 - ], - "translation_xyz_cm": [ - 2.063499283413339, - 1.7267244892522182, - 8.975704908934281 - ], - "translation_norm_m": 0.0937031938445524, - "rotation_rpy_deg_xyz": [ - 2.1121545886830053, - -0.3590367358023902, - -0.49840934190745567 - ], - "rotation_angle_deg": 2.198152858971854, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.005415677796178908, - 0.009517531303008475, - 0.027338610583958575 - ], - "translation_xyz_cm": [ - 0.5415677796178908, - 0.9517531303008475, - 2.7338610583958576 - ], - "translation_norm_m": 0.029450171421523223, - "rotation_rpy_deg_xyz": [ - 1.8573888274957828, - 0.43145439454353096, - 0.205073717451929 - ], - "rotation_angle_deg": 1.9170844772437752, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.009588245546250374, - 0.009401558653886033, - 0.010339461517525475 - ], - "translation_xyz_cm": [ - 0.9588245546250374, - 0.9401558653886033, - 1.0339461517525474 - ], - "translation_norm_m": 0.01694780877429409, - "rotation_rpy_deg_xyz": [ - 0.9597677235038649, - 1.0557128309952022, - -0.4906551349587616 - ], - "rotation_angle_deg": 1.5116429954571908, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0008167510039265302, - -0.016426459747164668, - 0.011555910670546725 - ], - "translation_xyz_cm": [ - -0.08167510039265302, - -1.6426459747164668, - 1.1555910670546725 - ], - "translation_norm_m": 0.02010061525061588, - "rotation_rpy_deg_xyz": [ - -0.6451338309701459, - -0.2729359724714745, - -0.697273725225632 - ], - "rotation_angle_deg": 0.9894535649768502, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005030742236358243, - 0.04080112546672965, - 0.0690844339531199 - ], - "translation_xyz_cm": [ - -0.5030742236358243, - 4.080112546672964, - 6.90844339531199 - ], - "translation_norm_m": 0.0803909150428298, - "rotation_rpy_deg_xyz": [ - -1.3277623379841577, - -0.49056287687666456, - 0.6090925040783209 - ], - "rotation_angle_deg": 1.5387152126776173, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02383315810861486, - 0.024668506538032986, - 0.049886782221625306 - ], - "translation_xyz_cm": [ - 2.383315810861486, - 2.4668506538032986, - 4.98867822216253 - ], - "translation_norm_m": 0.06054127253927754, - "rotation_rpy_deg_xyz": [ - -0.509553148412112, - -0.07169178239193863, - 0.49186875093964405 - ], - "rotation_angle_deg": 0.7116204915763964, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.008168540995544538, - -0.024531720732874962, - 0.023079248759939767 - ], - "translation_xyz_cm": [ - -0.8168540995544538, - -2.4531720732874964, - 2.3079248759939768 - ], - "translation_norm_m": 0.03465807420262759, - "rotation_rpy_deg_xyz": [ - 0.6952747814100542, - -0.6178201612424107, - -0.12656136988806582 - ], - "rotation_angle_deg": 0.938175180325416, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0035318898994751713, - 0.0006188922453423951, - 0.03202353765995061 - ], - "translation_xyz_cm": [ - -0.35318898994751713, - 0.061889224534239506, - 3.202353765995061 - ], - "translation_norm_m": 0.032223659601783826, - "rotation_rpy_deg_xyz": [ - 0.39183349651499577, - -1.2019617357018844, - 0.23521156248811265 - ], - "rotation_angle_deg": 1.2866606141461896, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.012789847460703552, - 0.007470468025288557, - 0.030385719771138922 - ], - "translation_xyz_cm": [ - -1.2789847460703552, - 0.7470468025288557, - 3.038571977113892 - ], - "translation_norm_m": 0.03380355094653676, - "rotation_rpy_deg_xyz": [ - -0.8208871439383635, - -1.0808237995614542, - 0.17361827053285486 - ], - "rotation_angle_deg": 1.3672853373204137, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009676105927339473, - 0.018131418999687954, - -0.048376313421369825 - ], - "translation_xyz_cm": [ - 0.9676105927339473, - 1.8131418999687954, - -4.837631342136983 - ], - "translation_norm_m": 0.052560851221245895, - "rotation_rpy_deg_xyz": [ - -0.29714640884567634, - -0.3339980552026732, - 0.09089356066947293 - ], - "rotation_angle_deg": 0.4560203866374267, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00438728986495085, - 0.004101758127807553, - -0.021876864738350463 - ], - "translation_xyz_cm": [ - -0.43872898649508496, - 0.4101758127807553, - -2.1876864738350466 - ], - "translation_norm_m": 0.02268633824305319, - "rotation_rpy_deg_xyz": [ - -0.042816125363480284, - -0.13499324042712507, - -0.050793745248947766 - ], - "rotation_angle_deg": 0.15047100026863872, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012317324836827792, - 0.022870572177132287, - -0.028055012236119052 - ], - "translation_xyz_cm": [ - 1.2317324836827792, - 2.2870572177132287, - -2.805501223611905 - ], - "translation_norm_m": 0.03823432063492357, - "rotation_rpy_deg_xyz": [ - 0.8521741430460135, - 0.379460933710213, - -0.1420726063514701 - ], - "rotation_angle_deg": 0.9440205119827517, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015612766954708146, - 0.012764078549765467, - -0.033728737310033896 - ], - "translation_xyz_cm": [ - 1.5612766954708146, - 1.2764078549765467, - -3.3728737310033896 - ], - "translation_norm_m": 0.039297683312580683, - "rotation_rpy_deg_xyz": [ - 0.8636714107205539, - 0.2698887070020635, - -0.08047373150498384 - ], - "rotation_angle_deg": 0.9086088911040517, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00401268287828116, - 0.0025759514787869753, - 0.020453226910591947 - ], - "translation_xyz_cm": [ - 0.40126828782811597, - 0.25759514787869753, - 2.045322691059195 - ], - "translation_norm_m": 0.021001705667847034, - "rotation_rpy_deg_xyz": [ - 1.1271435533022043, - -0.12217497954075623, - 0.020552888042921692 - ], - "rotation_angle_deg": 1.1339535438793684, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.07056095913428528, - "improved_pairs": 26, - "worsened_pairs": 40, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.032875044386196706, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015144034812935, - -6.733076264476427e-05, - 0.7136929353101595 - ], - "rotation_rpy_deg_xyz": [ - -0.789527196617764, - 1.5026289218840854, - -0.8356133538033519 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.1004916878666913, - "median": 0.057803787672271845, - "p90": 0.15913538848684716, - "p95": 0.20927612968709802, - "max": 0.3308236577464216 - }, - "rotation_deg": { - "rms": 1.1050268752403856, - "median": 0.881040458031074, - "p90": 1.6931314756229288, - "p95": 1.9442292316366117, - "max": 2.549887511222474 - }, - "normalized_pair_score": { - "rms": 2.9872678674890754, - "median": 2.4970994146564136, - "p90": 4.733430700188965, - "p95": 4.847682400714602, - "max": 6.797165127383953 - }, - "normalized_global_rms": 2.9872678674890754 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012754117697540701, - 0.01321423402618549, - 0.07467630123107978 - ], - "translation_xyz_cm": [ - -1.2754117697540701, - 1.321423402618549, - 7.467630123107978 - ], - "translation_norm_m": 0.0769014529426882, - "rotation_rpy_deg_xyz": [ - -0.4671822279622452, - -0.10039478582033169, - 0.026326843390341092 - ], - "rotation_angle_deg": 0.4785497243321324, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.669238092496052, - "median": 0.7629681084794777, - "p90": 2.2411288080915024, - "p95": 3.711431307771875, - "max": 5.607648580302171 - }, - "height_residual_m": { - "rms": 0.034713965171217276, - "median": -0.0059241016060887774, - "p90": 0.05340926734199069, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012754117697540701, - 0.01321423402618549, - 0.07467630123107978 - ], - "translation_xyz_cm": [ - -1.2754117697540701, - 1.321423402618549, - 7.467630123107978 - ], - "translation_norm_m": 0.0769014529426882, - "rotation_rpy_deg_xyz": [ - -0.4671822279622452, - -0.10039478582033169, - 0.026326843390341092 - ], - "rotation_angle_deg": 0.4785497243321324, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.020511175434618445, - -0.016188653629575667, - 0.12626207153659968 - ], - "translation_xyz_cm": [ - 2.0511175434618445, - -1.6188653629575667, - 12.62620715365997 - ], - "translation_norm_m": 0.1289375489636804, - "rotation_rpy_deg_xyz": [ - -0.18671152704122398, - -0.1782500040559989, - -0.34302764623514037 - ], - "rotation_angle_deg": 0.4295360884271374, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03339802688621629, - 0.006700966210313908, - 0.10213129034860603 - ], - "translation_xyz_cm": [ - 3.339802688621629, - 0.6700966210313908, - 10.213129034860604 - ], - "translation_norm_m": 0.10766211783313323, - "rotation_rpy_deg_xyz": [ - -0.07981970935455779, - -0.21561777418196643, - -0.3969867659274467 - ], - "rotation_angle_deg": 0.4588896719700004, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03429606862575585, - -0.019101638851041713, - 0.044579215054795014 - ], - "translation_xyz_cm": [ - 3.429606862575585, - -1.9101638851041713, - 4.457921505479502 - ], - "translation_norm_m": 0.059400331184934006, - "rotation_rpy_deg_xyz": [ - 0.32091072252069974, - 0.08734142047373276, - -0.3497332866951523 - ], - "rotation_angle_deg": 0.4828004885149152, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.046147203902671574, - 0.010701062186338262, - 0.0219662687460669 - ], - "translation_xyz_cm": [ - 4.614720390267157, - 1.0701062186338262, - 2.19662687460669 - ], - "translation_norm_m": 0.052216799237171374, - "rotation_rpy_deg_xyz": [ - 0.5027148994751668, - 0.2851160037371347, - -0.3804228385266284 - ], - "rotation_angle_deg": 0.6925928567772764, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.013990115869045278, - 0.0076641971557565025, - -0.03506088966551338 - ], - "translation_xyz_cm": [ - 1.3990115869045279, - 0.7664197155756503, - -3.5060889665513377 - ], - "translation_norm_m": 0.03851920617314071, - "rotation_rpy_deg_xyz": [ - 0.7450564831572104, - 0.23412105182200718, - 0.13866271289001536 - ], - "rotation_angle_deg": 0.7929224160890787, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.005325411439341403, - 0.020326322409281783, - -0.00986288737377779 - ], - "translation_xyz_cm": [ - 0.5325411439341403, - 2.0326322409281783, - -0.9862887373777791 - ], - "translation_norm_m": 0.02321197830931617, - "rotation_rpy_deg_xyz": [ - 0.33231974455663577, - 0.21718146043454795, - -0.03247223815714744 - ], - "rotation_angle_deg": 0.3983709495374952, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.032353316357629336, - -0.0012175181325369544, - -0.07162922315152437 - ], - "translation_xyz_cm": [ - -3.2353316357629334, - -0.12175181325369544, - -7.162922315152437 - ], - "translation_norm_m": 0.07860639311805864, - "rotation_rpy_deg_xyz": [ - 0.7326654634690407, - 0.5415789153781889, - 0.5382321661196461 - ], - "rotation_angle_deg": 1.0564386842724607, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.029830006901198386, - -0.018948393502075667, - -0.1297913631504376 - ], - "translation_xyz_cm": [ - -2.9830006901198387, - -1.8948393502075667, - -12.97913631504376 - ], - "translation_norm_m": 0.13451642604709588, - "rotation_rpy_deg_xyz": [ - 0.8690088791623053, - 0.3895703742503918, - 0.4049464656891813 - ], - "rotation_angle_deg": 1.0336942397533981, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03126149726922191, - -0.021163474659060433, - -0.0513307939314741 - ], - "translation_xyz_cm": [ - -3.1261497269221907, - -2.1163474659060433, - -5.13307939314741 - ], - "translation_norm_m": 0.06371831978947437, - "rotation_rpy_deg_xyz": [ - 0.5921070942240404, - 0.35912463226373714, - 0.5882300473956759 - ], - "rotation_angle_deg": 0.9074069975875975, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03776491485383672, - -0.03934091377689963, - -0.07746995431007916 - ], - "translation_xyz_cm": [ - -3.776491485383672, - -3.9340913776899633, - -7.7469954310079165 - ], - "translation_norm_m": 0.09473906328186248, - "rotation_rpy_deg_xyz": [ - 0.8069781317644149, - 0.81488511546382, - 0.5056242024651121 - ], - "rotation_angle_deg": 1.251033426269492, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013238404667166435, - -0.011033982141765653, - -0.030319561192041548 - ], - "translation_xyz_cm": [ - -1.3238404667166435, - -1.1033982141765653, - -3.0319561192041546 - ], - "translation_norm_m": 0.03487520481537577, - "rotation_rpy_deg_xyz": [ - 0.39890906157208783, - 0.27502989396684585, - -0.08595883719900999 - ], - "rotation_angle_deg": 0.492263192822224, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.013350637314862357, - -0.003543174492869325, - -0.21117955533367264 - ], - "translation_xyz_cm": [ - 1.3350637314862357, - -0.3543174492869325, - -21.117955533367265 - ], - "translation_norm_m": 0.21163080634238393, - "rotation_rpy_deg_xyz": [ - 0.17781164492225826, - 0.17572006673016077, - 0.3011573474645493 - ], - "rotation_angle_deg": 0.39118521473828716, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.011142810206158038, - 0.016782267847672873, - -0.19647277596354606 - ], - "translation_xyz_cm": [ - 1.1142810206158038, - 1.6782267847672874, - -19.647277596354606 - ], - "translation_norm_m": 0.1975028061274656, - "rotation_rpy_deg_xyz": [ - 0.2578389989819103, - -0.0861028524092402, - 0.4035581523669184 - ], - "rotation_angle_deg": 0.486733893991857, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.005632746929182031, - 0.004557046307704871, - -0.1333265881265962 - ], - "translation_xyz_cm": [ - -0.5632746929182031, - 0.45570463077048706, - -13.33265881265962 - ], - "translation_norm_m": 0.13352330736803145, - "rotation_rpy_deg_xyz": [ - 0.7131420131192636, - -0.2368467910440698, - -0.08706302484889217 - ], - "rotation_angle_deg": 0.7563004778769722, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008695504379009344, - 0.015042653886250812, - -0.13908918738904175 - ], - "translation_xyz_cm": [ - 0.8695504379009344, - 1.5042653886250812, - -13.908918738904175 - ], - "translation_norm_m": 0.1401702367868831, - "rotation_rpy_deg_xyz": [ - -0.7170556581039831, - 0.6854064320564691, - 0.29332212359925375 - ], - "rotation_angle_deg": 1.0356140470582071, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009651371894333682, - -0.0035160393302418047, - -0.061438875212363755 - ], - "translation_xyz_cm": [ - -0.9651371894333682, - -0.35160393302418047, - -6.143887521236375 - ], - "translation_norm_m": 0.06229162784335426, - "rotation_rpy_deg_xyz": [ - -0.5719256129316125, - 0.2582013563155895, - -0.2076711456464235 - ], - "rotation_angle_deg": 0.6605739349061962, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.008971152181465714, - -0.020585723429421863, - 0.07309053187448877 - ], - "translation_xyz_cm": [ - -0.8971152181465714, - -2.0585723429421865, - 7.309053187448877 - ], - "translation_norm_m": 0.07646227455596206, - "rotation_rpy_deg_xyz": [ - 0.39473017254510406, - -0.35655340215797143, - -0.4815663491638006 - ], - "rotation_angle_deg": 0.7167030693504132, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0013959861725622025, - -0.0035694751170609607, - 0.00333345610348847 - ], - "translation_xyz_cm": [ - 0.13959861725622025, - -0.35694751170609607, - 0.33334561034884697 - ], - "translation_norm_m": 0.005079553090497899, - "rotation_rpy_deg_xyz": [ - 0.3197558885989856, - -0.2724133896493295, - -0.4748712093121267 - ], - "rotation_angle_deg": 0.6334290863223099, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.005321755045305188, - 0.013480535775909464, - -0.06918798610269358 - ], - "translation_xyz_cm": [ - 0.5321755045305188, - 1.3480535775909464, - -6.918798610269358 - ], - "translation_norm_m": 0.07068962683813182, - "rotation_rpy_deg_xyz": [ - -0.5295397890654403, - -0.2925649738406982, - -0.3030875205999282 - ], - "rotation_angle_deg": 0.6772641783834975, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010458979538632007, - 0.02003810229943148, - -0.06307301853370757 - ], - "translation_xyz_cm": [ - 1.0458979538632007, - 2.003810229943148, - -6.307301853370757 - ], - "translation_norm_m": 0.06700090643943128, - "rotation_rpy_deg_xyz": [ - 0.12042227428314684, - 0.013553812623009016, - 0.007430293854184903 - ], - "rotation_angle_deg": 0.12140933857173933, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012952732171880865, - 0.03927041581326507, - -0.11239333431108585 - ], - "translation_xyz_cm": [ - 1.2952732171880865, - 3.927041581326507, - -11.239333431108586 - ], - "translation_norm_m": 0.11975892629122359, - "rotation_rpy_deg_xyz": [ - -0.8072212425753459, - -0.1833953780362801, - 0.1699205588735543 - ], - "rotation_angle_deg": 0.8447916291782677, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006859284238813879, - 0.016110286104011773, - -0.05351421621752127 - ], - "translation_xyz_cm": [ - 0.6859284238813879, - 1.6110286104011773, - -5.351421621752126 - ], - "translation_norm_m": 0.056305971583816686, - "rotation_rpy_deg_xyz": [ - -0.8689165051986111, - -0.07608122910608621, - 0.16688600631834588 - ], - "rotation_angle_deg": 0.8879538178155421, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0016130065487740541, - -0.017291652663236512, - -0.1686843444185022 - ], - "translation_xyz_cm": [ - -0.1613006548774054, - -1.7291652663236512, - -16.86843444185022 - ], - "translation_norm_m": 0.1695759744004211, - "rotation_rpy_deg_xyz": [ - -0.3830797904574831, - 1.650170749518356, - -0.331114874842211 - ], - "rotation_angle_deg": 1.7250447389541173, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.003359122861121999, - 0.011367530901767231, - -0.03612316215912643 - ], - "translation_xyz_cm": [ - -0.3359122861121999, - 1.136753090176723, - -3.6123162159126427 - ], - "translation_norm_m": 0.038018249691079795, - "rotation_rpy_deg_xyz": [ - 0.608757108605623, - 0.39043884257379646, - 0.20412189723651325 - ], - "rotation_angle_deg": 0.7508959325680399, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.014065468787775703, - 0.019930819447314896, - -0.036923626123670394 - ], - "translation_xyz_cm": [ - 1.4065468787775703, - 1.9930819447314896, - -3.6923626123670394 - ], - "translation_norm_m": 0.04425414265559726, - "rotation_rpy_deg_xyz": [ - 0.8595344297168985, - 0.9346584620008738, - 0.19710870074185416 - ], - "rotation_angle_deg": 1.2839221115838206, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.003836540956490442, - 0.003939329898687838, - -0.027858076352091383 - ], - "translation_xyz_cm": [ - -0.3836540956490442, - 0.3939329898687838, - -2.7858076352091383 - ], - "translation_norm_m": 0.02839559445759989, - "rotation_rpy_deg_xyz": [ - -0.2932418176842062, - 2.447925844485932, - 0.6446666364454465 - ], - "rotation_angle_deg": 2.549887511222474, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01630520774120714, - 0.014139962085349067, - -0.009923582246065016 - ], - "translation_xyz_cm": [ - 1.630520774120714, - 1.4139962085349067, - -0.9923582246065016 - ], - "translation_norm_m": 0.023754490351372455, - "rotation_rpy_deg_xyz": [ - 0.418190932304449, - 0.2881906743159378, - -0.011076477311861756 - ], - "rotation_angle_deg": 0.5080188365235904, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.0005729810919530287, - 0.005787994463778645, - 0.009513486556872877 - ], - "translation_xyz_cm": [ - 0.05729810919530287, - 0.5787994463778645, - 0.9513486556872878 - ], - "translation_norm_m": 0.011150588043339637, - "rotation_rpy_deg_xyz": [ - 0.222764843315744, - 1.8798476224582814, - 0.4863697507286901 - ], - "rotation_angle_deg": 1.9535675159034995, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.017882849435879034, - 0.005479860455417818, - 0.23570591610710123 - ], - "translation_xyz_cm": [ - 1.7882849435879034, - 0.5479860455417818, - 23.570591610710125 - ], - "translation_norm_m": 0.23644683136478065, - "rotation_rpy_deg_xyz": [ - 0.025436787564901572, - 0.17482399045261662, - -0.2819849893897571 - ], - "rotation_angle_deg": 0.33278794231995495, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.005759421739913728, - -0.009862751905657663, - 0.029676610398982867 - ], - "translation_xyz_cm": [ - 0.5759421739913728, - -0.9862751905657663, - 2.9676610398982866 - ], - "translation_norm_m": 0.031798522272328364, - "rotation_rpy_deg_xyz": [ - 0.48619697858670613, - 1.5558534690460741, - 0.5255555123189408 - ], - "rotation_angle_deg": 1.7106444046316411, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.036842128761104154, - -0.010773321385600498, - 0.22708088106345486 - ], - "translation_xyz_cm": [ - 3.6842128761104154, - -1.0773321385600498, - 22.708088106345485 - ], - "translation_norm_m": 0.23030226540327853, - "rotation_rpy_deg_xyz": [ - 0.4358253749247479, - -0.10604806775315798, - -0.2383653677960376 - ], - "rotation_angle_deg": 0.5077552299258097, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.036797923935912635, - 0.0037410828824486764, - 0.32874946329628424 - ], - "translation_xyz_cm": [ - 3.6797923935912635, - 0.37410828824486764, - 32.87494632962842 - ], - "translation_norm_m": 0.3308236577464216, - "rotation_rpy_deg_xyz": [ - -0.05412905551222446, - 0.7442116811435467, - -0.22205871243860761 - ], - "rotation_angle_deg": 0.7784177475873618, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.007751726803569614, - 0.011329390639903014, - 0.14805978505859044 - ], - "translation_xyz_cm": [ - 0.7751726803569614, - 1.1329390639903014, - 14.805978505859043 - ], - "translation_norm_m": 0.14869480257327322, - "rotation_rpy_deg_xyz": [ - 1.0553576903612276, - -1.425595725592852, - -0.7384209552014623 - ], - "rotation_angle_deg": 1.916214378835948, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011031272107893564, - 0.02253260535326662, - 0.20064975954470615 - ], - "translation_xyz_cm": [ - -1.1031272107893564, - 2.253260535326662, - 20.064975954470615 - ], - "translation_norm_m": 0.20221209972124032, - "rotation_rpy_deg_xyz": [ - 0.9904786141162382, - -0.3172842352995258, - -0.688619638376147 - ], - "rotation_angle_deg": 1.2458417314562336, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002722739847200062, - -0.013108737997161057, - 0.1024662586561336 - ], - "translation_xyz_cm": [ - 0.2722739847200062, - -1.3108737997161057, - 10.24662586561336 - ], - "translation_norm_m": 0.10333724636905812, - "rotation_rpy_deg_xyz": [ - -0.5899942361682126, - 0.6490893668253772, - 0.007636925247081254 - ], - "rotation_angle_deg": 0.8772205240689238, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0013092051394535398, - -0.005891243048300243, - -0.05308619316409124 - ], - "translation_xyz_cm": [ - 0.13092051394535398, - -0.5891243048300243, - -5.308619316409124 - ], - "translation_norm_m": 0.053428126182812403, - "rotation_rpy_deg_xyz": [ - -0.30823470881648185, - 0.6638249841602342, - 0.09527351844061997 - ], - "rotation_angle_deg": 0.7383009832708094, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.000305829450234274, - 0.02545474290972005, - 0.028605399411666205 - ], - "translation_xyz_cm": [ - 0.0305829450234274, - 2.545474290972005, - 2.8605399411666204 - ], - "translation_norm_m": 0.03829237970867738, - "rotation_rpy_deg_xyz": [ - -0.670927352394488, - -0.059320945162793126, - -0.7362017090479659 - ], - "rotation_angle_deg": 0.9980784326541213, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014802227733057727, - -0.04288152802817491, - -0.014874697230913477 - ], - "translation_xyz_cm": [ - 1.4802227733057727, - -4.288152802817491, - -1.4874697230913476 - ], - "translation_norm_m": 0.04774084215432106, - "rotation_rpy_deg_xyz": [ - 0.33433965918758896, - 0.13931830163164804, - -0.6395355289771951 - ], - "rotation_angle_deg": 0.7353344779155774, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0030873590542883633, - 0.01132668654090141, - 0.007171337449266527 - ], - "translation_xyz_cm": [ - 0.30873590542883633, - 1.132668654090141, - 0.7171337449266526 - ], - "translation_norm_m": 0.01375695077904933, - "rotation_rpy_deg_xyz": [ - 0.09318407923060984, - 0.18456983867256527, - 0.1483896846865894 - ], - "rotation_angle_deg": 0.25440955498933, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.006639523013829418, - -0.01364226927104989, - -0.0015778634706750672 - ], - "translation_xyz_cm": [ - 0.6639523013829418, - -1.364226927104989, - -0.15778634706750672 - ], - "translation_norm_m": 0.015253997176054981, - "rotation_rpy_deg_xyz": [ - -1.2112557753694466, - -0.9902346417424631, - 0.15448919686066662 - ], - "rotation_angle_deg": 1.571082441547839, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006662878474425149, - 0.00039441457198924335, - 0.05892478846949487 - ], - "translation_xyz_cm": [ - 0.6662878474425149, - 0.039441457198924335, - 5.892478846949487 - ], - "translation_norm_m": 0.05930160376072701, - "rotation_rpy_deg_xyz": [ - -0.06837607401948174, - -0.21323295921751284, - -0.12995232038699242 - ], - "rotation_angle_deg": 0.2589676234364985, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.004987123739785382, - -0.02974152315837536, - 0.008299599250221626 - ], - "translation_xyz_cm": [ - -0.4987123739785382, - -2.974152315837536, - 0.8299599250221625 - ], - "translation_norm_m": 0.031277994671819805, - "rotation_rpy_deg_xyz": [ - 1.1206230898171896, - 0.2618390097009116, - -0.1910992823496523 - ], - "rotation_angle_deg": 1.166983271299156, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011446678898185958, - 0.019387338305032475, - 0.030338428179015223 - ], - "translation_xyz_cm": [ - -1.1446678898185958, - 1.9387338305032475, - 3.0338428179015224 - ], - "translation_norm_m": 0.03777983018391189, - "rotation_rpy_deg_xyz": [ - 0.2999495386373908, - 1.162035190141584, - -0.27681572340514565 - ], - "rotation_angle_deg": 1.2323151150773601, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021834551166075578, - -0.032712282688967975, - -0.061290727853742386 - ], - "translation_xyz_cm": [ - 0.21834551166075578, - -3.2712282688967975, - -6.129072785374238 - ], - "translation_norm_m": 0.06950837529255526, - "rotation_rpy_deg_xyz": [ - 0.7882339272882655, - 0.46453417179279993, - -0.07447087597231694 - ], - "rotation_angle_deg": 0.918217312987476, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.019029965504610225, - 0.008649633111896371, - -0.13126038790407218 - ], - "translation_xyz_cm": [ - 1.9029965504610225, - 0.8649633111896371, - -13.126038790407218 - ], - "translation_norm_m": 0.13291442800841663, - "rotation_rpy_deg_xyz": [ - 0.23018034537261586, - 1.1175790921492832, - -0.019920599702315384 - ], - "rotation_angle_deg": 1.1412495760359145, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.006556302986341578, - 0.023254284341683196, - -0.12865364975404792 - ], - "translation_xyz_cm": [ - 0.6556302986341578, - 2.3254284341683196, - -12.865364975404791 - ], - "translation_norm_m": 0.1309026678266329, - "rotation_rpy_deg_xyz": [ - -0.024429691199242886, - 1.5009872228222239, - 0.22253408810213987 - ], - "rotation_angle_deg": 1.517636460248039, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018747804187171146, - 0.016326715184082796, - -0.039009104527387775 - ], - "translation_xyz_cm": [ - -1.8747804187171146, - 1.6326715184082796, - -3.9009104527387777 - ], - "translation_norm_m": 0.04625745374068202, - "rotation_rpy_deg_xyz": [ - 0.25187845244707896, - 0.1393551662803256, - 0.08003518245965324 - ], - "rotation_angle_deg": 0.29869578449052353, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.030611550498516382, - 0.020423399610432713, - -0.07052300828674504 - ], - "translation_xyz_cm": [ - -3.061155049851638, - 2.0423399610432713, - -7.052300828674504 - ], - "translation_norm_m": 0.07954669681000558, - "rotation_rpy_deg_xyz": [ - 0.533199824973564, - 0.8547951137973345, - 0.33092099040580664 - ], - "rotation_angle_deg": 1.059171816094831, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009138566287286931, - 0.012168155673566217, - -0.03746446219473293 - ], - "translation_xyz_cm": [ - -0.9138566287286931, - 1.2168155673566217, - -3.7464462194732926 - ], - "translation_norm_m": 0.040437152889686134, - "rotation_rpy_deg_xyz": [ - 0.5330293693876373, - 0.6613204709461823, - 0.2511217543985133 - ], - "rotation_angle_deg": 0.8848603919932242, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.010408054022772006, - -0.0023387044342224605, - 0.060238400784749235 - ], - "translation_xyz_cm": [ - 1.0408054022772006, - -0.23387044342224605, - 6.023840078474923 - ], - "translation_norm_m": 0.06117566555482392, - "rotation_rpy_deg_xyz": [ - 1.5920059573974432, - 0.09328888270996957, - -0.2610153253741009 - ], - "rotation_angle_deg": 1.616164101807619, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007250632219955477, - 0.008057140584174283, - 0.009017525390051587 - ], - "translation_xyz_cm": [ - -0.7250632219955477, - 0.8057140584174283, - 0.9017525390051586 - ], - "translation_norm_m": 0.014099820784053597, - "rotation_rpy_deg_xyz": [ - 1.4918584304124831, - 0.587918836533132, - 0.42096170349774287 - ], - "rotation_angle_deg": 1.655905690513936, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.021756373384319794, - 0.015725922741676168, - 0.09460212367134765 - ], - "translation_xyz_cm": [ - 2.1756373384319794, - 1.5725922741676168, - 9.460212367134766 - ], - "translation_norm_m": 0.0983372067533142, - "rotation_rpy_deg_xyz": [ - 2.2105815831546027, - -0.2564411231056031, - -0.490621545436372 - ], - "rotation_angle_deg": 2.2777730046531284, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.007201927921822282, - 0.008381479176190476, - 0.027734328583969542 - ], - "translation_xyz_cm": [ - 0.7201927921822282, - 0.8381479176190476, - 2.773432858396954 - ], - "translation_norm_m": 0.029854814368467073, - "rotation_rpy_deg_xyz": [ - 1.9462876972556118, - 0.5741296166895596, - 0.21403393230623677 - ], - "rotation_angle_deg": 2.0394264929950316, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011904564038967447, - 0.008702333523734396, - 0.0085567429872931 - ], - "translation_xyz_cm": [ - 1.1904564038967447, - 0.8702333523734396, - 0.85567429872931 - ], - "translation_norm_m": 0.017048961970359898, - "rotation_rpy_deg_xyz": [ - 1.0160464473471853, - 1.2373059199385135, - -0.48359657928779864 - ], - "rotation_angle_deg": 1.6756185466142162, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0007429903772278035, - -0.017063057606139298, - 0.013298600429642315 - ], - "translation_xyz_cm": [ - -0.07429903772278035, - -1.7063057606139298, - 1.3298600429642315 - ], - "translation_norm_m": 0.021646079159015473, - "rotation_rpy_deg_xyz": [ - -0.5962803071636105, - -0.25935943578604703, - -0.6959948643371069 - ], - "rotation_angle_deg": 0.953466923085724, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005161863206924799, - 0.04150549086370525, - 0.07562741304762562 - ], - "translation_xyz_cm": [ - -0.5161863206924799, - 4.150549086370525, - 7.562741304762562 - ], - "translation_norm_m": 0.08642254455800465, - "rotation_rpy_deg_xyz": [ - -1.3768440808907498, - -0.47850339884573495, - 0.6077288452158585 - ], - "rotation_angle_deg": 1.577016319194004, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024512403438020414, - 0.025911894691640125, - 0.05694664593761874 - ], - "translation_xyz_cm": [ - 2.4512403438020414, - 2.5911894691640125, - 5.694664593761874 - ], - "translation_norm_m": 0.06719527284239146, - "rotation_rpy_deg_xyz": [ - -0.6067566062264121, - -0.0004442326279066463, - 0.48969055174729736 - ], - "rotation_angle_deg": 0.7797089638392719, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.007888588650885486, - -0.023704287551194025, - 0.025202009121396744 - ], - "translation_xyz_cm": [ - -0.7888588650885486, - -2.3704287551194025, - 2.5202009121396745 - ], - "translation_norm_m": 0.03548611479110578, - "rotation_rpy_deg_xyz": [ - 0.6243875658470935, - -0.589730906566391, - -0.12764956055273244 - ], - "rotation_angle_deg": 0.8678206480836086, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003393704163737965, - 0.001349888079171413, - 0.034638250715639904 - ], - "translation_xyz_cm": [ - -0.3393704163737965, - 0.1349888079171413, - 3.46382507156399 - ], - "translation_norm_m": 0.03483027186825836, - "rotation_rpy_deg_xyz": [ - 0.32915537252877486, - -1.1809807014663454, - 0.23404185184291187 - ], - "rotation_angle_deg": 1.2487658739696963, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.011623080890649007, - 0.008715155213274095, - 0.0311152763780687 - ], - "translation_xyz_cm": [ - -1.1623080890649007, - 0.8715155213274095, - 3.1115276378068697 - ], - "translation_norm_m": 0.034339632552862716, - "rotation_rpy_deg_xyz": [ - -0.9221921033299263, - -0.984632153950116, - 0.170908717973468 - ], - "rotation_angle_deg": 1.3588295381249569, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011454400156202915, - 0.01918145316678499, - -0.04684585614356356 - ], - "translation_xyz_cm": [ - 1.1454400156202915, - 1.918145316678499, - -4.684585614356356 - ], - "translation_norm_m": 0.05190053628192525, - "rotation_rpy_deg_xyz": [ - -0.38602506869271896, - -0.18549993781062057, - 0.08979861006881007 - ], - "rotation_angle_deg": 0.43746654037161986, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0039283035552926115, - 0.005049315186078207, - -0.02220299955166502 - ], - "translation_xyz_cm": [ - -0.39283035552926115, - 0.5049315186078207, - -2.220299955166502 - ], - "translation_norm_m": 0.02310628359910182, - "rotation_rpy_deg_xyz": [ - -0.11995665714557782, - -0.10031212568290666, - -0.05232194167956691 - ], - "rotation_angle_deg": 0.16492631953056403, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.013421259529148521, - 0.02413806371300886, - -0.030880233787270346 - ], - "translation_xyz_cm": [ - 1.3421259529148521, - 2.413806371300886, - -3.088023378727035 - ], - "translation_norm_m": 0.041429037714126406, - "rotation_rpy_deg_xyz": [ - 0.7521486653054597, - 0.46280006020498643, - -0.14229535057390852 - ], - "rotation_angle_deg": 0.8949974865044467, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01591588881312811, - 0.013537730762341993, - -0.038722375845645376 - ], - "translation_xyz_cm": [ - 1.591588881312811, - 1.3537730762341993, - -3.872237584564538 - ], - "translation_norm_m": 0.044000091613960735, - "rotation_rpy_deg_xyz": [ - 0.8116997410383687, - 0.2836129785328784, - -0.08140239053800945 - ], - "rotation_angle_deg": 0.8638545810528749, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004166129782936734, - 0.003198668461998233, - 0.018190717024790904 - ], - "translation_xyz_cm": [ - 0.4166129782936734, - 0.3198668461998233, - 1.8190717024790903 - ], - "translation_norm_m": 0.018933840159198353, - "rotation_rpy_deg_xyz": [ - 1.0840789796824881, - -0.11308099506713808, - 0.01976097721021556 - ], - "rotation_angle_deg": 1.090159130001415, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.1316264760464274, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.06946933674042727, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0024476764333135033, - 0.7204936800355414 - ], - "rotation_rpy_deg_xyz": [ - -0.9851737312819089, - 1.1997371245619126, - -0.8397031987625543 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10257010426899679, - "median": 0.05602816670800314, - "p90": 0.15999146706115064, - "p95": 0.2218332086949717, - "max": 0.3422529107160327 - }, - "rotation_deg": { - "rms": 1.0267538544989139, - "median": 0.9059669105305697, - "p90": 1.6460900636188316, - "p95": 1.8065285086137317, - "max": 2.4300870518313142 - }, - "normalized_pair_score": { - "rms": 2.9026099336312234, - "median": 2.3996486974974713, - "p90": 4.524332615234902, - "p95": 4.875329338975845, - "max": 7.003441863944355 - }, - "normalized_global_rms": 2.9026099336312234 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.011862708697826074, - 0.013972426143507688, - 0.07604268003645409 - ], - "translation_xyz_cm": [ - -1.1862708697826074, - 1.3972426143507688, - 7.604268003645409 - ], - "translation_norm_m": 0.07822046878606513, - "rotation_rpy_deg_xyz": [ - -0.541482719819371, - -0.0637266630892246, - 0.024819357496703668 - ], - "rotation_angle_deg": 0.5457706857344996, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7107124278398285, - "median": 0.7334463903250042, - "p90": 2.3653698912452787, - "p95": 4.0266291870908315, - "max": 5.724141872865437 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.011862708697826074, - 0.013972426143507688, - 0.07604268003645409 - ], - "translation_xyz_cm": [ - -1.1862708697826074, - 1.3972426143507688, - 7.604268003645409 - ], - "translation_norm_m": 0.07822046878606513, - "rotation_rpy_deg_xyz": [ - -0.541482719819371, - -0.0637266630892246, - 0.024819357496703668 - ], - "rotation_angle_deg": 0.5457706857344996, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021884758090912948, - -0.014401607085913204, - 0.13136342147234598 - ], - "translation_xyz_cm": [ - 2.188475809091295, - -1.4401607085913204, - 13.136342147234597 - ], - "translation_norm_m": 0.1339503543268028, - "rotation_rpy_deg_xyz": [ - -0.3411487315866048, - -0.12290144584962129, - -0.3460685068801038 - ], - "rotation_angle_deg": 0.501501180601739, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03476968230027355, - 0.009911850173705883, - 0.10748792968374292 - ], - "translation_xyz_cm": [ - 3.4769682300273552, - 0.9911850173705883, - 10.748792968374293 - ], - "translation_norm_m": 0.11340560219330088, - "rotation_rpy_deg_xyz": [ - -0.33103742238834116, - -0.16221857588085575, - -0.40227751130058514 - ], - "rotation_angle_deg": 0.5459892308924431, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034989288786325345, - -0.01834221554805099, - 0.04750500446603653 - ], - "translation_xyz_cm": [ - 3.4989288786325345, - -1.8342215548050989, - 4.750500446603653 - ], - "translation_norm_m": 0.06178521384847824, - "rotation_rpy_deg_xyz": [ - 0.24714139852928368, - 0.12383493666369755, - -0.35072741062734897 - ], - "rotation_angle_deg": 0.44677819871751584, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04715810104964524, - 0.0127184893171165, - 0.02484727408455813 - ], - "translation_xyz_cm": [ - 4.715810104964524, - 1.27184893171165, - 2.484727408455813 - ], - "translation_norm_m": 0.0547999406436842, - "rotation_rpy_deg_xyz": [ - 0.33424751739044706, - 0.34183533894451984, - -0.3831042791961537 - ], - "rotation_angle_deg": 0.6132735794423378, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.014288975471018706, - 0.011953259765026258, - -0.03091365441074326 - ], - "translation_xyz_cm": [ - 1.4288975471018706, - 1.1953259765026258, - -3.091365441074326 - ], - "translation_norm_m": 0.03609306398809106, - "rotation_rpy_deg_xyz": [ - 0.39784404592517136, - 0.2585255143837464, - 0.13109256455760793 - ], - "rotation_angle_deg": 0.4920009077588037, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00587532542847782, - 0.021423066916313543, - -0.010215949718934657 - ], - "translation_xyz_cm": [ - 0.587532542847782, - 2.1423066916313545, - -1.0215949718934656 - ], - "translation_norm_m": 0.02445062113017105, - "rotation_rpy_deg_xyz": [ - 0.2446713128621526, - 0.2583466530988345, - -0.033694996720690165 - ], - "rotation_angle_deg": 0.3574625369550116, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031978442893913835, - 0.0020952833851497488, - -0.07090716107262503 - ], - "translation_xyz_cm": [ - -3.1978442893913837, - 0.20952833851497488, - -7.0907161072625025 - ], - "translation_norm_m": 0.0778128300074132, - "rotation_rpy_deg_xyz": [ - 0.4635470008843789, - 0.5918076958326788, - 0.53318580640598 - ], - "rotation_angle_deg": 0.9202393204535686, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03003048503498773, - -0.014420072237022796, - -0.1285661688277236 - ], - "translation_xyz_cm": [ - -3.003048503498773, - -1.4420072237022796, - -12.856616882772359 - ], - "translation_norm_m": 0.1328120035305405, - "rotation_rpy_deg_xyz": [ - 0.49256304321568595, - 0.3988079612942599, - 0.39631801274248823 - ], - "rotation_angle_deg": 0.7465740117312964, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.030828101413242825, - -0.01899897628782729, - -0.05055372428651778 - ], - "translation_xyz_cm": [ - -3.0828101413242823, - -1.8998976287827292, - -5.055372428651778 - ], - "translation_norm_m": 0.06218530353683148, - "rotation_rpy_deg_xyz": [ - 0.4195884533171335, - 0.4161324209897413, - 0.5855464907316213 - ], - "rotation_angle_deg": 0.8308412211602583, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.037549183715323814, - -0.035851952746542404, - -0.07657494530905 - ], - "translation_xyz_cm": [ - -3.7549183715323813, - -3.5851952746542404, - -7.657494530905 - ], - "translation_norm_m": 0.09251500398590191, - "rotation_rpy_deg_xyz": [ - 0.5200185744125289, - 0.8609458529605756, - 0.5001015846243679 - ], - "rotation_angle_deg": 1.1215299291061964, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012730290269494023, - -0.00968152838721223, - -0.030932971931169492 - ], - "translation_xyz_cm": [ - -1.2730290269494022, - -0.9681528387212229, - -3.0932971931169493 - ], - "translation_norm_m": 0.034822995775097954, - "rotation_rpy_deg_xyz": [ - 0.2936680043662151, - 0.3212370253283076, - -0.08744652315413347 - ], - "rotation_angle_deg": 0.44409991550278916, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011828238417734505, - 0.0009958720554986145, - -0.2091125049866387 - ], - "translation_xyz_cm": [ - 1.1828238417734505, - 0.09958720554986145, - -20.91125049866387 - ], - "translation_norm_m": 0.209449131597638, - "rotation_rpy_deg_xyz": [ - -0.2605106996801804, - 0.1395128624614032, - 0.2902835413474647 - ], - "rotation_angle_deg": 0.41446123324378165, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.010205037168989017, - 0.020491490559482562, - -0.1930986369979152 - ], - "translation_xyz_cm": [ - 1.0205037168989017, - 2.049149055948256, - -19.30986369979152 - ], - "translation_norm_m": 0.1944508358928355, - "rotation_rpy_deg_xyz": [ - -0.08425216167557584, - -0.05945730286791173, - 0.39594093432022526 - ], - "rotation_angle_deg": 0.40910653962144095, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.007174476908647698, - 0.009942542939002319, - -0.13411827454217476 - ], - "translation_xyz_cm": [ - -0.7174476908647698, - 0.9942542939002319, - -13.411827454217477 - ], - "translation_norm_m": 0.13467753652772532, - "rotation_rpy_deg_xyz": [ - 0.2304676906093252, - -0.32157056657033944, - -0.10046291170733894 - ], - "rotation_angle_deg": 0.4080265369290913, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008455517119271283, - 0.01693976089265392, - -0.1313167666506156 - ], - "translation_xyz_cm": [ - 0.8455517119271283, - 1.6939760892653921, - -13.131676665061558 - ], - "translation_norm_m": 0.13267458110891778, - "rotation_rpy_deg_xyz": [ - -0.8589352425955696, - 0.7390515558348104, - 0.29006933878870467 - ], - "rotation_angle_deg": 1.1710285946725474, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009597928510114206, - 0.000354440673477896, - -0.06017105884344634 - ], - "translation_xyz_cm": [ - -0.9597928510114206, - 0.0354440673477896, - -6.017105884344634 - ], - "translation_norm_m": 0.0609327677216271, - "rotation_rpy_deg_xyz": [ - -0.8923415998490479, - 0.29356856409564036, - -0.2151322386779515 - ], - "rotation_angle_deg": 0.9631985893768465, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.00761480483573429, - -0.01836000718203095, - 0.06625233262178318 - ], - "translation_xyz_cm": [ - -0.761480483573429, - -1.836000718203095, - 6.625233262178318 - ], - "translation_norm_m": 0.0691696949121358, - "rotation_rpy_deg_xyz": [ - 0.22448295598602463, - -0.2997065050503686, - -0.48439551500534817 - ], - "rotation_angle_deg": 0.6117890608253307, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.002206761277007918, - -0.0003230168700503744, - -0.0008326113697621623 - ], - "translation_xyz_cm": [ - 0.2206761277007918, - -0.03230168700503744, - -0.08326113697621623 - ], - "translation_norm_m": 0.0023806253222831983, - "rotation_rpy_deg_xyz": [ - 0.06595145035821497, - -0.21939243755063725, - -0.47985956969274 - ], - "rotation_angle_deg": 0.5316261357000228, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.005322118167739309, - 0.017714413705690712, - -0.06959397062120509 - ], - "translation_xyz_cm": [ - 0.5322118167739309, - 1.7714413705690712, - -6.959397062120509 - ], - "translation_norm_m": 0.07201004194938995, - "rotation_rpy_deg_xyz": [ - -0.8796751315539549, - -0.26974120747481045, - -0.3112744395859724 - ], - "rotation_angle_deg": 0.9719907575067247, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010498512271429783, - 0.021105741161081215, - -0.062073216285429625 - ], - "translation_xyz_cm": [ - 1.0498512271429783, - 2.1105741161081215, - -6.207321628542963 - ], - "translation_norm_m": 0.06639845818909988, - "rotation_rpy_deg_xyz": [ - 0.04535756883865925, - 0.05050677400062785, - 0.006285325021587809 - ], - "rotation_angle_deg": 0.06817255413092452, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012803844285578792, - 0.04150144791112176, - -0.10958401117735066 - ], - "translation_xyz_cm": [ - 1.2803844285578792, - 4.150144791112176, - -10.958401117735066 - ], - "translation_norm_m": 0.11787690237246064, - "rotation_rpy_deg_xyz": [ - -0.9812013910240344, - -0.12637778099477365, - 0.16580979262889156 - ], - "rotation_angle_deg": 1.0029259565636819, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007024816096084352, - 0.017364227581084246, - -0.052790548078376395 - ], - "translation_xyz_cm": [ - 0.7024816096084352, - 1.7364227581084246, - -5.27905480783764 - ], - "translation_norm_m": 0.05601523370554534, - "rotation_rpy_deg_xyz": [ - -0.9605481423764163, - -0.03372400271012844, - 0.16470440258387845 - ], - "rotation_angle_deg": 0.9751019434315028, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.001803682951671659, - -0.014644278210358408, - -0.15859654933809655 - ], - "translation_xyz_cm": [ - -0.1803682951671659, - -1.4644278210358408, - -15.859654933809656 - ], - "translation_norm_m": 0.15928142898167327, - "rotation_rpy_deg_xyz": [ - -0.604325359187065, - 1.7069599784467653, - -0.3359420695890839 - ], - "rotation_angle_deg": 1.840025499694327, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.002920662503063054, - 0.012849793579804092, - -0.035424476333908474 - ], - "translation_xyz_cm": [ - -0.2920662503063054, - 1.2849793579804092, - -3.5424476333908475 - ], - "translation_norm_m": 0.03779604460829221, - "rotation_rpy_deg_xyz": [ - 0.4921485944775216, - 0.439402608723218, - 0.20259978647740304 - ], - "rotation_angle_deg": 0.6896123928297053, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.014485991915168084, - 0.022725822239365367, - -0.026386143827412778 - ], - "translation_xyz_cm": [ - 1.4485991915168084, - 2.2725822239365367, - -2.638614382741278 - ], - "translation_norm_m": 0.037716515537658854, - "rotation_rpy_deg_xyz": [ - 0.6118983782856572, - 0.9886896894560481, - 0.19279747455130533 - ], - "rotation_angle_deg": 1.177731508981917, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.007018485086774273, - 0.010908407621013083, - -0.016295321405351334 - ], - "translation_xyz_cm": [ - -0.7018485086774273, - 1.0908407621013083, - -1.6295321405351333 - ], - "translation_norm_m": 0.020827625631433616, - "rotation_rpy_deg_xyz": [ - -0.8477310560778221, - 2.1838940726501863, - 0.6301295448881703 - ], - "rotation_angle_deg": 2.4300870518313142, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016776002454337302, - 0.0155037858310062, - -0.002114031766567201 - ], - "translation_xyz_cm": [ - 1.6776002454337302, - 1.55037858310062, - -0.2114031766567201 - ], - "translation_norm_m": 0.022940592053207674, - "rotation_rpy_deg_xyz": [ - 0.29699016857760974, - 0.33815104708946925, - -0.012849980541250472 - ], - "rotation_angle_deg": 0.45026290024770477, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0010907088369185303, - 0.012439554331656, - 0.01569560254970474 - ], - "translation_xyz_cm": [ - -0.10907088369185303, - 1.2439554331656, - 1.569560254970474 - ], - "translation_norm_m": 0.02005702114311723, - "rotation_rpy_deg_xyz": [ - -0.2961542013792496, - 1.7373384628845212, - 0.4720162782717484 - ], - "rotation_angle_deg": 1.8256686622280407, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.012935122665748255, - 0.013771143443305878, - 0.24929020324509518 - ], - "translation_xyz_cm": [ - 1.2935122665748255, - 1.3771143443305878, - 24.92902032450952 - ], - "translation_norm_m": 0.25000513439546584, - "rotation_rpy_deg_xyz": [ - -0.5267842472129214, - -0.1799242373979309, - -0.29895312921785816 - ], - "rotation_angle_deg": 0.6322507085237045, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.005457743908056756, - -0.0040665189434838656, - 0.025501089736010764 - ], - "translation_xyz_cm": [ - 0.5457743908056756, - -0.40665189434838656, - 2.5501089736010765 - ], - "translation_norm_m": 0.026393732638786, - "rotation_rpy_deg_xyz": [ - 0.04603516591774468, - 1.5182663365528828, - 0.5144175758293887 - ], - "rotation_angle_deg": 1.6035068443034852, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.034210551568836234, - -0.0025434504069030694, - 0.2344054731347398 - ], - "translation_xyz_cm": [ - 3.4210551568836234, - -0.25434504069030694, - 23.44054731347398 - ], - "translation_norm_m": 0.2369024204480351, - "rotation_rpy_deg_xyz": [ - -0.11134892780675792, - -0.3296865791435226, - -0.25537257238229577 - ], - "rotation_angle_deg": 0.43182214069998553, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03138685034156752, - 0.01263944056672539, - 0.3405762250383795 - ], - "translation_xyz_cm": [ - 3.138685034156752, - 1.263944056672539, - 34.05762250383795 - ], - "translation_norm_m": 0.3422529107160327, - "rotation_rpy_deg_xyz": [ - -0.6013116663704227, - 0.3615215875026331, - -0.2387006252676891 - ], - "rotation_angle_deg": 0.7405025294031278, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009137920646322684, - 0.013583520920428915, - 0.15986544379611584 - ], - "translation_xyz_cm": [ - 0.9137920646322684, - 1.3583520920428915, - 15.986544379611583 - ], - "translation_norm_m": 0.160701505140628, - "rotation_rpy_deg_xyz": [ - 0.8484422715755146, - -1.3679878241237988, - -0.741456718559852 - ], - "rotation_angle_deg": 1.7680251016339168, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009801906762904267, - 0.027220818930151047, - 0.22410138127526333 - ], - "translation_xyz_cm": [ - -0.9801906762904267, - 2.7220818930151047, - 22.410138127526334 - ], - "translation_norm_m": 0.22596123439408292, - "rotation_rpy_deg_xyz": [ - 0.6297513245059657, - -0.29949022299709843, - -0.6966056360314147 - ], - "rotation_angle_deg": 0.9845001675553328, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003941458997618108, - -0.011342399143650983, - 0.11105571137876899 - ], - "translation_xyz_cm": [ - 0.3941458997618108, - -1.1342399143650983, - 11.105571137876899 - ], - "translation_norm_m": 0.1117029818187869, - "rotation_rpy_deg_xyz": [ - -0.739214872435925, - 0.7037713918011522, - 0.004330514671302538 - ], - "rotation_angle_deg": 1.0206782071492313, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0017067558207800038, - -0.0025635273686299698, - -0.04627768032865373 - ], - "translation_xyz_cm": [ - 0.17067558207800038, - -0.256352736862997, - -4.627768032865373 - ], - "translation_norm_m": 0.046380042956023076, - "rotation_rpy_deg_xyz": [ - -0.5797201231143607, - 0.7134573071811255, - 0.089255162120271 - ], - "rotation_angle_deg": 0.9239605154272846, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006491512351978201, - 0.027984727154258815, - 0.04796715829717854 - ], - "translation_xyz_cm": [ - 0.06491512351978201, - 2.7984727154258815, - 4.796715829717854 - ], - "translation_norm_m": 0.05553750648283603, - "rotation_rpy_deg_xyz": [ - -0.8739536008449633, - -0.0017265021665758822, - -0.7408750397469878 - ], - "rotation_angle_deg": 1.145732329167195, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015479254399599185, - -0.038875101141406354, - -0.026907080797172814 - ], - "translation_xyz_cm": [ - 1.5479254399599185, - -3.8875101141406354, - -2.6907080797172815 - ], - "translation_norm_m": 0.04974808340577223, - "rotation_rpy_deg_xyz": [ - 0.027203249509821417, - 0.17939932428271854, - -0.6460335130032695 - ], - "rotation_angle_deg": 0.6710723594408088, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.004220500723695508, - 0.014878454571362498, - -0.00935036543379502 - ], - "translation_xyz_cm": [ - 0.42205007236955083, - 1.4878454571362498, - -0.935036543379502 - ], - "translation_norm_m": 0.018072364829659696, - "rotation_rpy_deg_xyz": [ - -0.1699492353694372, - 0.23592625592481645, - 0.14294394250570153 - ], - "rotation_angle_deg": 0.3241556089243036, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.008383774783964348, - -0.011481034137462376, - -0.026899124591413887 - ], - "translation_xyz_cm": [ - 0.8383774783964348, - -1.1481034137462376, - -2.6899124591413885 - ], - "translation_norm_m": 0.030424738754477747, - "rotation_rpy_deg_xyz": [ - -1.4010206685584425, - -0.932651022498358, - 0.14958957343314738 - ], - "rotation_angle_deg": 1.6886732829341777, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006765024920033946, - 0.0062594799762789866, - 0.0518512750837777 - ], - "translation_xyz_cm": [ - 0.6765024920033946, - 0.6259479976278987, - 5.185127508377771 - ], - "translation_norm_m": 0.05266404256754037, - "rotation_rpy_deg_xyz": [ - -0.5067619523444589, - -0.2496112080194829, - -0.14067500895733773 - ], - "rotation_angle_deg": 0.582419861657302, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01228483265921021, - -0.02410472025382232, - 0.019838107310334988 - ], - "translation_xyz_cm": [ - -1.228483265921021, - -2.410472025382232, - 1.9838107310334987 - ], - "translation_norm_m": 0.03354854920315029, - "rotation_rpy_deg_xyz": [ - 0.6605557338745041, - -0.2853661621079659, - -0.21894181722667275 - ], - "rotation_angle_deg": 0.751652448737909, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010381008299317873, - 0.022545229310150017, - 0.04107819016614633 - ], - "translation_xyz_cm": [ - -1.0381008299317873, - 2.2545229310150017, - 4.107819016614633 - ], - "translation_norm_m": 0.04799448307132639, - "rotation_rpy_deg_xyz": [ - 0.039130002020063115, - 1.2138599492193627, - -0.28201120565151955 - ], - "rotation_angle_deg": 1.246895427205954, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008365007658843737, - -0.02646163009271585, - -0.0672252669008099 - ], - "translation_xyz_cm": [ - 0.08365007658843737, - -2.646163009271585, - -6.722526690080991 - ], - "translation_norm_m": 0.0722506339804723, - "rotation_rpy_deg_xyz": [ - 0.2883530701373031, - 0.3553265212262298, - -0.08898099231574966 - ], - "rotation_angle_deg": 0.4663484308021419, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.013063956636419682, - 0.014472468709150643, - -0.1362750222436117 - ], - "translation_xyz_cm": [ - 1.3063956636419682, - 1.4472468709150643, - -13.627502224361171 - ], - "translation_norm_m": 0.1376626347308247, - "rotation_rpy_deg_xyz": [ - -0.2632228524914937, - 0.6114494184072145, - -0.03924822008306795 - ], - "rotation_angle_deg": 0.6667729437351414, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0007707594110548666, - 0.027371968201510555, - -0.1331160868371599 - ], - "translation_xyz_cm": [ - -0.07707594110548666, - 2.7371968201510555, - -13.311608683715988 - ], - "translation_norm_m": 0.1359033159570896, - "rotation_rpy_deg_xyz": [ - -0.36981463699914235, - 0.8701677436854842, - 0.20679162645861507 - ], - "rotation_angle_deg": 0.9684396662419882, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018802976405497773, - 0.021297077310893586, - -0.05130521615992469 - ], - "translation_xyz_cm": [ - -1.8802976405497773, - 2.1297077310893586, - -5.130521615992469 - ], - "translation_norm_m": 0.058645908884665456, - "rotation_rpy_deg_xyz": [ - -0.14490220819361774, - 0.1357623103923054, - 0.07061657725235224 - ], - "rotation_angle_deg": 0.21080556664220482, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03263600186863436, - 0.026693993916131142, - -0.07622428955633086 - ], - "translation_xyz_cm": [ - -3.2636001868634357, - 2.6693993916131142, - -7.622428955633086 - ], - "translation_norm_m": 0.08710809518943301, - "rotation_rpy_deg_xyz": [ - 0.010582282226487728, - 0.7041578648041859, - 0.3155468405565625 - ], - "rotation_angle_deg": 0.7716720796274404, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008535328780574392, - 0.014443141564858819, - -0.03537609465982737 - ], - "translation_xyz_cm": [ - -0.8535328780574392, - 1.444314156485882, - -3.537609465982737 - ], - "translation_norm_m": 0.03915257653125935, - "rotation_rpy_deg_xyz": [ - 0.34824841459641154, - 0.7189071662439137, - 0.24809777480623468 - ], - "rotation_angle_deg": 0.8358051851448747, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007123883710499657, - 0.0053440557194659455, - 0.045578909976909665 - ], - "translation_xyz_cm": [ - 0.7123883710499657, - 0.5344055719465945, - 4.557890997690967 - ], - "translation_norm_m": 0.046440776106097904, - "rotation_rpy_deg_xyz": [ - 1.0360812278738656, - -0.20317589668802832, - -0.28553434760711205 - ], - "rotation_angle_deg": 1.093262147919508, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01280759761649719, - 0.014598842277689483, - 0.008966860768096177 - ], - "translation_xyz_cm": [ - -1.280759761649719, - 1.4598842277689483, - 0.8966860768096176 - ], - "translation_norm_m": 0.02139077709176038, - "rotation_rpy_deg_xyz": [ - 0.964049152287267, - 0.1455829965047165, - 0.3921696368483664 - ], - "rotation_angle_deg": 1.0504367418527434, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.020721540849391484, - 0.022484706239763508, - 0.08907560210795681 - ], - "translation_xyz_cm": [ - 2.0721540849391484, - 2.248470623976351, - 8.907560210795681 - ], - "translation_norm_m": 0.09417753002046986, - "rotation_rpy_deg_xyz": [ - 1.7095980990705746, - -0.3673144399479668, - -0.5079699401591495 - ], - "rotation_angle_deg": 1.8193629776070035, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004222595874015855, - 0.01577650607567538, - 0.018042575910081446 - ], - "translation_xyz_cm": [ - 0.42225958740158553, - 1.5776506075675378, - 1.8042575910081446 - ], - "translation_norm_m": 0.024336454247530167, - "rotation_rpy_deg_xyz": [ - 1.3938375374812237, - 0.3238239385255256, - 0.18981421146592253 - ], - "rotation_angle_deg": 1.4429733602918131, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0065319607452565265, - 0.015743286195249118, - 0.0035094992870426805 - ], - "translation_xyz_cm": [ - 0.6531960745256526, - 1.5743286195249118, - 0.35094992870426805 - ], - "translation_norm_m": 0.017402130807715667, - "rotation_rpy_deg_xyz": [ - 0.48384929762611883, - 0.8049604680038971, - -0.5085061776875379 - ], - "rotation_angle_deg": 1.069624729901989, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.00038163018121561976, - -0.014890997248942994, - 0.004878772510311005 - ], - "translation_xyz_cm": [ - 0.038163018121561976, - -1.4890997248942994, - 0.4878772510311005 - ], - "translation_norm_m": 0.015674497180790486, - "rotation_rpy_deg_xyz": [ - -0.7700039406685949, - -0.20234228267361537, - -0.6998896871165098 - ], - "rotation_angle_deg": 1.060937676562648, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00642013471774483, - 0.0396487459315924, - 0.06651887220962917 - ], - "translation_xyz_cm": [ - -0.642013471774483, - 3.96487459315924, - 6.651887220962917 - ], - "translation_norm_m": 0.07770457865391803, - "rotation_rpy_deg_xyz": [ - -1.2537279219394992, - -0.6129076551931512, - 0.6116377738454287 - ], - "rotation_angle_deg": 1.5209713443977422, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.019432872008785296, - 0.023788408978217657, - 0.05307540151333297 - ], - "translation_xyz_cm": [ - 1.9432872008785296, - 2.3788408978217657, - 5.3075401513332965 - ], - "translation_norm_m": 0.06132310463460151, - "rotation_rpy_deg_xyz": [ - -0.4575528269524971, - -0.4086377636786511, - 0.4906793560271351 - ], - "rotation_angle_deg": 0.7845388581324091, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.010699745307287678, - -0.02563092545478618, - 0.024245459891891287 - ], - "translation_xyz_cm": [ - -1.0699745307287678, - -2.563092545478618, - 2.4245459891891286 - ], - "translation_norm_m": 0.036868295521747946, - "rotation_rpy_deg_xyz": [ - 0.7810434318791329, - -0.8157406307694492, - -0.1302278706641813 - ], - "rotation_angle_deg": 1.1362050564660704, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005644661489842218, - -0.0004575503985776441, - 0.0323325844901744 - ], - "translation_xyz_cm": [ - -0.5644661489842218, - -0.04575503985776441, - 3.23325844901744 - ], - "translation_norm_m": 0.032824801225847695, - "rotation_rpy_deg_xyz": [ - 0.4754006888735035, - -1.3693094476530787, - 0.2332519109305661 - ], - "rotation_angle_deg": 1.469032703512236, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.018055864453315085, - 0.007357305848301243, - 0.03805759736340708 - ], - "translation_xyz_cm": [ - -1.8055864453315085, - 0.7357305848301243, - 3.805759736340708 - ], - "translation_norm_m": 0.0427612547474597, - "rotation_rpy_deg_xyz": [ - -0.8104871463006269, - -1.475986456177483, - 0.17336505308787728 - ], - "rotation_angle_deg": 1.6916922671910237, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0039928586759065965, - 0.01971220067077417, - -0.052307657958153626 - ], - "translation_xyz_cm": [ - 0.39928586759065965, - 1.9712200670774171, - -5.230765795815363 - ], - "translation_norm_m": 0.05604109971046094, - "rotation_rpy_deg_xyz": [ - -0.41617305849848346, - -0.8087510438140599, - 0.08379653518431802 - ], - "rotation_angle_deg": 0.9131291497846249, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.007345260352235039, - 0.003014863969969639, - -0.016030954449801786 - ], - "translation_xyz_cm": [ - -0.7345260352235039, - 0.3014863969969639, - -1.6030954449801786 - ], - "translation_norm_m": 0.01788948727524511, - "rotation_rpy_deg_xyz": [ - 0.042194771309552036, - -0.3586488338075367, - -0.05232277315442333 - ], - "rotation_angle_deg": 0.36487425616113806, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007774507576636003, - 0.022547222647278264, - -0.026018343121312203 - ], - "translation_xyz_cm": [ - 0.7774507576636003, - 2.2547222647278264, - -2.60183431213122 - ], - "translation_norm_m": 0.03529552940449318, - "rotation_rpy_deg_xyz": [ - 0.8856541371412744, - 0.012897979988288805, - -0.15254599964197754 - ], - "rotation_angle_deg": 0.8988046712765143, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.013786092784828341, - 0.011658706509600658, - -0.025569940325557924 - ], - "translation_xyz_cm": [ - 1.378609278482834, - 1.1658706509600658, - -2.5569940325557923 - ], - "translation_norm_m": 0.03130181528284732, - "rotation_rpy_deg_xyz": [ - 0.9402311297443766, - 0.13854902428668187, - -0.08283503707756197 - ], - "rotation_angle_deg": 0.9540858447151216, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0025843191916425923, - 0.0014625542423660765, - 0.026114262209797425 - ], - "translation_xyz_cm": [ - 0.2584319191642592, - 0.14625542423660765, - 2.6114262209797423 - ], - "translation_norm_m": 0.02628255051090379, - "rotation_rpy_deg_xyz": [ - 1.19517089849679, - -0.2264465782480122, - 0.01837057344178999 - ], - "rotation_angle_deg": 1.2166075417205533, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.04696854218857549, - "improved_pairs": 22, - "worsened_pairs": 44, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.058852162807430775, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0011901746480735614, - 0.7204968546603007 - ], - "rotation_rpy_deg_xyz": [ - -0.8851624923523462, - 1.2012008027315206, - -0.837607902463532 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10143505999644054, - "median": 0.05503112563476724, - "p90": 0.15934336010911088, - "p95": 0.22111937238887025, - "max": 0.337133380692983 - }, - "rotation_deg": { - "rms": 1.0151691591975842, - "median": 0.8717289020286703, - "p90": 1.5618900400692686, - "p95": 1.7626459866526927, - "max": 2.30321856589359 - }, - "normalized_pair_score": { - "rms": 2.870174601960012, - "median": 2.3829548210861398, - "p90": 4.4446377227974345, - "p95": 4.84535992519406, - "max": 6.838494896460945 - }, - "normalized_global_rms": 2.870174601960012 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012198472231590096, - 0.01406397926648073, - 0.07674205808328792 - ], - "translation_xyz_cm": [ - -1.2198472231590096, - 1.406397926648073, - 7.674205808328792 - ], - "translation_norm_m": 0.07896797905766369, - "rotation_rpy_deg_xyz": [ - -0.538507900251355, - -0.08651768006822559, - 0.024724500603810116 - ], - "rotation_angle_deg": 0.545955313109902, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.685676496509504, - "median": 0.7553149459813134, - "p90": 2.3646467024572515, - "p95": 3.99536236407491, - "max": 5.626801242035707 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012198472231590096, - 0.01406397926648073, - 0.07674205808328792 - ], - "translation_xyz_cm": [ - -1.2198472231590096, - 1.406397926648073, - 7.674205808328792 - ], - "translation_norm_m": 0.07896797905766369, - "rotation_rpy_deg_xyz": [ - -0.538507900251355, - -0.08651768006822559, - 0.024724500603810116 - ], - "rotation_angle_deg": 0.545955313109902, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021206993608963498, - -0.014344119831277258, - 0.13220502886113733 - ], - "translation_xyz_cm": [ - 2.12069936089635, - -1.4344119831277258, - 13.220502886113733 - ], - "translation_norm_m": 0.13466127879921094, - "rotation_rpy_deg_xyz": [ - -0.3301467913749382, - -0.16706207538237808, - -0.3463000555288329 - ], - "rotation_angle_deg": 0.5071126466746416, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03375120903065354, - 0.009747130464839548, - 0.10859263309211162 - ], - "translation_xyz_cm": [ - 3.375120903065354, - 0.9747130464839548, - 10.859263309211162 - ], - "translation_norm_m": 0.11413374008244648, - "rotation_rpy_deg_xyz": [ - -0.30468670572341167, - -0.22841890329282416, - -0.4024385784033479 - ], - "rotation_angle_deg": 0.5544854457502064, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03467528506293793, - -0.01830165565934405, - 0.04795162786943227 - ], - "translation_xyz_cm": [ - 3.4675285062937933, - -1.8301655659344052, - 4.795162786943227 - ], - "translation_norm_m": 0.06194097681985424, - "rotation_rpy_deg_xyz": [ - 0.2500771759506376, - 0.10120038624273704, - -0.3511335765010256 - ], - "rotation_angle_deg": 0.442978277706443, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04650045646911394, - 0.012626928199015452, - 0.025613521943092445 - ], - "translation_xyz_cm": [ - 4.650045646911394, - 1.2626928199015452, - 2.5613521943092445 - ], - "translation_norm_m": 0.05456907800126671, - "rotation_rpy_deg_xyz": [ - 0.34709251693925564, - 0.29424231129078426, - -0.3838949195377323 - ], - "rotation_angle_deg": 0.5959113296525195, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.01320098773320813, - 0.01134521032317215, - -0.030186667961096016 - ], - "translation_xyz_cm": [ - 1.320098773320813, - 1.134521032317215, - -3.0186667961096014 - ], - "translation_norm_m": 0.034845585043198575, - "rotation_rpy_deg_xyz": [ - 0.44567297870881334, - 0.17466148055404976, - 0.13010867216277497 - ], - "rotation_angle_deg": 0.49586518905744487, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.0055332266881600424, - 0.0213729282346789, - -0.009861035264755213 - ], - "translation_xyz_cm": [ - 0.5533226688160042, - 2.13729282346789, - -0.9861035264755214 - ], - "translation_norm_m": 0.024179716197673767, - "rotation_rpy_deg_xyz": [ - 0.24866433873639016, - 0.2317916318533378, - -0.0341590930790452 - ], - "rotation_angle_deg": 0.34170518454995, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03281322627871578, - 0.0016587133623240935, - -0.07049471452915668 - ], - "translation_xyz_cm": [ - -3.281322627871578, - 0.16587133623240935, - -7.049471452915668 - ], - "translation_norm_m": 0.07777508550547436, - "rotation_rpy_deg_xyz": [ - 0.49338048612825613, - 0.5219990112593001, - 0.5320886289188058 - ], - "rotation_angle_deg": 0.8925404499167059, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.031067922192100333, - -0.015184168092016614, - -0.1279166472132429 - ], - "translation_xyz_cm": [ - -3.1067922192100332, - -1.5184168092016614, - -12.791664721324288 - ], - "translation_norm_m": 0.13250827666322681, - "rotation_rpy_deg_xyz": [ - 0.5483910121677101, - 0.3105405458292672, - 0.39524540872920194 - ], - "rotation_angle_deg": 0.743108326408813, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.031404281718908134, - -0.019237177506948006, - -0.05039654268608686 - ], - "translation_xyz_cm": [ - -3.1404281718908136, - -1.9237177506948004, - -5.039654268608686 - ], - "translation_norm_m": 0.062418822669327474, - "rotation_rpy_deg_xyz": [ - 0.4329895504693059, - 0.3675628568786115, - 0.5846731747698455 - ], - "rotation_angle_deg": 0.814123843782237, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038399731279221985, - -0.03635585097705207, - -0.0760934662644942 - ], - "translation_xyz_cm": [ - -3.8399731279221987, - -3.6355850977052073, - -7.609346626449421 - ], - "translation_norm_m": 0.09266338473597753, - "rotation_rpy_deg_xyz": [ - 0.5535519647174143, - 0.7876704292547586, - 0.49892185785439724 - ], - "rotation_angle_deg": 1.0825710430572544, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01312350509996326, - -0.009782260763087497, - -0.03053411651414376 - ], - "translation_xyz_cm": [ - -1.312350509996326, - -0.9782260763087497, - -3.053411651414376 - ], - "translation_norm_m": 0.034644642919867276, - "rotation_rpy_deg_xyz": [ - 0.29920522487343987, - 0.28984819678897566, - -0.08800523252935184 - ], - "rotation_angle_deg": 0.42592680856608056, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011011753742565022, - -4.618575750360565e-05, - -0.20972503290816683 - ], - "translation_xyz_cm": [ - 1.1011753742565022, - -0.004618575750360565, - -20.972503290816682 - ], - "translation_norm_m": 0.21001392878079003, - "rotation_rpy_deg_xyz": [ - -0.18468487967984368, - 0.043923457264721404, - 0.29068371890102007 - ], - "rotation_angle_deg": 0.3472403715879457, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.009486337051113125, - 0.019724921661124314, - -0.19399441264550918 - ], - "translation_xyz_cm": [ - 0.9486337051113125, - 1.9724921661124315, - -19.39944126455092 - ], - "translation_norm_m": 0.19522524238136038, - "rotation_rpy_deg_xyz": [ - -0.03773303477861644, - -0.1425090634061527, - 0.395648615388523 - ], - "rotation_angle_deg": 0.4221767669887697, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.008203219409898543, - 0.008727334686987331, - -0.1331185564535311 - ], - "translation_xyz_cm": [ - -0.8203219409898543, - 0.8727334686987331, - -13.31185564535311 - ], - "translation_norm_m": 0.1336563101828626, - "rotation_rpy_deg_xyz": [ - 0.32435752788695116, - -0.41994152171651905, - -0.10057719546545216 - ], - "rotation_angle_deg": 0.539847025518986, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008034432197865593, - 0.016612132545862246, - -0.13086107925755863 - ], - "translation_xyz_cm": [ - 0.8034432197865593, - 1.6612132545862246, - -13.086107925755863 - ], - "translation_norm_m": 0.1321557305337776, - "rotation_rpy_deg_xyz": [ - -0.8494857483470171, - 0.6980579150878031, - 0.29020940620293917 - ], - "rotation_angle_deg": 1.1384746104914347, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.010541830516368422, - -0.00022697466472343386, - -0.05817531329476353 - ], - "translation_xyz_cm": [ - -1.0541830516368422, - -0.022697466472343386, - -5.8175313294763535 - ], - "translation_norm_m": 0.05912316623015172, - "rotation_rpy_deg_xyz": [ - -0.8511998164223709, - 0.21417571906166674, - -0.21435801564155296 - ], - "rotation_angle_deg": 0.9031488961069318, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.00830217692273516, - -0.018436633345940732, - 0.06717962881048428 - ], - "translation_xyz_cm": [ - -0.830217692273516, - -1.8436633345940732, - 6.717962881048428 - ], - "translation_norm_m": 0.07015652583974993, - "rotation_rpy_deg_xyz": [ - 0.23758448150937006, - -0.34773923417066127, - -0.4850988035827928 - ], - "rotation_angle_deg": 0.6418637634154216, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0013352252405872678, - -0.0006744268660137109, - 0.0003259477141177355 - ], - "translation_xyz_cm": [ - 0.13352252405872678, - -0.0674426866013711, - 0.03259477141177355 - ], - "translation_norm_m": 0.0015309865946640357, - "rotation_rpy_deg_xyz": [ - 0.09279868962745053, - -0.28612432775716423, - -0.4804787082809953 - ], - "rotation_angle_deg": 0.5666703677321191, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.004308329615535289, - 0.01705570279963764, - -0.06829583608263107 - ], - "translation_xyz_cm": [ - 0.4308329615535289, - 1.705570279963764, - -6.829583608263107 - ], - "translation_norm_m": 0.07052503050897091, - "rotation_rpy_deg_xyz": [ - -0.83106202464551, - -0.35408148402839684, - -0.3103730910765064 - ], - "rotation_angle_deg": 0.9560120731749809, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010223387359974523, - 0.0209418871491317, - -0.06136486232941757 - ], - "translation_xyz_cm": [ - 1.0223387359974523, - 2.09418871491317, - -6.136486232941757 - ], - "translation_norm_m": 0.0656408913344984, - "rotation_rpy_deg_xyz": [ - 0.048386653755154566, - 0.027500476893906618, - 0.005954451336816827 - ], - "rotation_angle_deg": 0.055971971966886226, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012263002202483109, - 0.04114342566625595, - -0.10809827991284617 - ], - "translation_xyz_cm": [ - 1.2263002202483109, - 4.114342566625595, - -10.809827991284617 - ], - "translation_norm_m": 0.1163116538386798, - "rotation_rpy_deg_xyz": [ - -0.9675871085365938, - -0.17531250966360992, - 0.16612860346133385 - ], - "rotation_angle_deg": 0.9970279598010798, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00668383470953815, - 0.017215032488996473, - -0.05177655943492826 - ], - "translation_xyz_cm": [ - 0.668383470953815, - 1.7215032488996473, - -5.177655943492826 - ], - "translation_norm_m": 0.0549712933897347, - "rotation_rpy_deg_xyz": [ - -0.9562223115136043, - -0.06139276020998848, - 0.16480626488402633 - ], - "rotation_angle_deg": 0.9721737007040958, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0023818054829005675, - -0.015124403813261189, - -0.15706622926213487 - ], - "translation_xyz_cm": [ - -0.23818054829005675, - -1.512440381326119, - -15.706622926213488 - ], - "translation_norm_m": 0.15781071244592515, - "rotation_rpy_deg_xyz": [ - -0.5833982976907289, - 1.647188865057987, - -0.33585960199926124 - ], - "rotation_angle_deg": 1.777841715753, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0033555641205761932, - 0.01269090705169651, - -0.03410423576257162 - ], - "translation_xyz_cm": [ - -0.3355564120576193, - 1.269090705169651, - -3.410423576257162 - ], - "translation_norm_m": 0.03654336915654011, - "rotation_rpy_deg_xyz": [ - 0.49879847528774107, - 0.4049706285694429, - 0.20187934644574493 - ], - "rotation_angle_deg": 0.6729362542696209, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.013691967393155258, - 0.022345478804360885, - -0.02562507828159473 - ], - "translation_xyz_cm": [ - 1.3691967393155258, - 2.2345478804360885, - -2.562507828159473 - ], - "translation_norm_m": 0.03665289935365586, - "rotation_rpy_deg_xyz": [ - 0.6375348514233531, - 0.9232631837403339, - 0.19155346834360854 - ], - "rotation_angle_deg": 1.137356797577235, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.008090075100802618, - 0.009033526669866898, - -0.013889774821725043 - ], - "translation_xyz_cm": [ - -0.8090075100802618, - 0.9033526669866898, - -1.3889774821725043 - ], - "translation_norm_m": 0.01843854017621921, - "rotation_rpy_deg_xyz": [ - -0.7014686086482326, - 2.0966614738838056, - 0.632949810672328 - ], - "rotation_angle_deg": 2.30321856589359, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01632134668262397, - 0.015401530598008861, - -0.0016442042812163937 - ], - "translation_xyz_cm": [ - 1.6321346682623972, - 1.5401530598008861, - -0.16442042812163937 - ], - "translation_norm_m": 0.022501042420611853, - "rotation_rpy_deg_xyz": [ - 0.30411796793750545, - 0.30250270614242664, - -0.013469480348835767 - ], - "rotation_angle_deg": 0.429183485262026, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0023687006259740517, - 0.010971268401535506, - 0.01817477920270082 - ], - "translation_xyz_cm": [ - -0.23687006259740517, - 1.0971268401535506, - 1.817477920270082 - ], - "translation_norm_m": 0.021361228243266996, - "rotation_rpy_deg_xyz": [ - -0.18342386889989107, - 1.6395943972343312, - 0.4731921792404563 - ], - "rotation_angle_deg": 1.7170587993517705, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01173567430945155, - 0.011413303390501284, - 0.24766489185847557 - ], - "translation_xyz_cm": [ - 1.173567430945155, - 1.1413303390501284, - 24.766489185847558 - ], - "translation_norm_m": 0.24820533476348075, - "rotation_rpy_deg_xyz": [ - -0.3599459252915823, - -0.25281727591322406, - -0.29608232127829553 - ], - "rotation_angle_deg": 0.5306712728297631, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.00418969627958421, - -0.005056348127250809, - 0.02763877449419072 - ], - "translation_xyz_cm": [ - 0.41896962795842096, - -0.5056348127250809, - 2.763877449419072 - ], - "translation_norm_m": 0.028408133814804556, - "rotation_rpy_deg_xyz": [ - 0.1224315721089144, - 1.4225349399417122, - 0.5143153284836152 - ], - "rotation_angle_deg": 1.5170819253724177, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03270285666162531, - -0.004369015554693156, - 0.2326206297579615 - ], - "translation_xyz_cm": [ - 3.2702856661625312, - -0.43690155546931564, - 23.262062975796148 - ], - "translation_norm_m": 0.23494876573359258, - "rotation_rpy_deg_xyz": [ - 0.024500017160899952, - -0.42159031146048764, - -0.2539557532533365 - ], - "rotation_angle_deg": 0.49273328458463955, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03019133555022324, - 0.010076323570388457, - 0.3356275723752124 - ], - "translation_xyz_cm": [ - 3.019133555022324, - 1.0076323570388457, - 33.56275723752124 - ], - "translation_norm_m": 0.337133380692983, - "rotation_rpy_deg_xyz": [ - -0.4288032322117365, - 0.2941269272689741, - -0.2355800702902815 - ], - "rotation_angle_deg": 0.5704046585386735, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.008220880945538411, - 0.013626632286904083, - 0.16008691978343773 - ], - "translation_xyz_cm": [ - 0.8220880945538411, - 1.3626632286904083, - 16.008691978343773 - ], - "translation_norm_m": 0.1608760077722966, - "rotation_rpy_deg_xyz": [ - 0.8670614060910731, - -1.4245954295039638, - -0.742839440307638 - ], - "rotation_angle_deg": 1.8212594138570661, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011305896689445927, - 0.026873579207242315, - 0.22292275238512355 - ], - "translation_xyz_cm": [ - -1.1305896689445927, - 2.6873579207242315, - 22.292275238512353 - ], - "translation_norm_m": 0.22482118692489697, - "rotation_rpy_deg_xyz": [ - 0.681218044507589, - -0.38546417297660784, - -0.6979143450767922 - ], - "rotation_angle_deg": 1.047147189411602, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0033185067986751804, - -0.011313747328124624, - 0.11158224091324118 - ], - "translation_xyz_cm": [ - 0.33185067986751804, - -1.1313747328124624, - 11.158224091324117 - ], - "translation_norm_m": 0.11220343066590296, - "rotation_rpy_deg_xyz": [ - -0.7288741303263682, - 0.6609242570827203, - 0.004396790976407384 - ], - "rotation_angle_deg": 0.9839353531077534, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0008233633212458291, - -0.0029882147541471227, - -0.043522002260380735 - ], - "translation_xyz_cm": [ - 0.08233633212458291, - -0.29882147541471227, - -4.352200226038073 - ], - "translation_norm_m": 0.04363223619444987, - "rotation_rpy_deg_xyz": [ - -0.5493984805754152, - 0.6431754084917372, - 0.089435925685316 - ], - "rotation_angle_deg": 0.8509173541406347, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -5.6546766625587e-05, - 0.027783753359931884, - 0.047571772006217414 - ], - "translation_xyz_cm": [ - -0.0056546766625587, - 2.7783753359931884, - 4.757177200621741 - ], - "translation_norm_m": 0.05509095787979978, - "rotation_rpy_deg_xyz": [ - -0.8560017333688674, - -0.05745183385124318, - -0.7405671175817861 - ], - "rotation_angle_deg": 1.1336245767915163, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01443808210121178, - -0.039448024246860225, - -0.021929844131010432 - ], - "translation_xyz_cm": [ - 1.443808210121178, - -3.9448024246860225, - -2.192984413101043 - ], - "translation_norm_m": 0.047386948576085976, - "rotation_rpy_deg_xyz": [ - 0.06523717676486462, - 0.10235760944953026, - -0.6465560966924323 - ], - "rotation_angle_deg": 0.657908010932712, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.00322817241234441, - 0.014476517566775593, - -0.0038785556533487003 - ], - "translation_xyz_cm": [ - 0.322817241234441, - 1.4476517566775593, - -0.38785556533487003 - ], - "translation_norm_m": 0.015330813805571674, - "rotation_rpy_deg_xyz": [ - -0.14129684929874753, - 0.16730165686979753, - 0.14261069890810382 - ], - "rotation_angle_deg": 0.2614407296023921, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.007606089908610336, - -0.011659696628856797, - -0.023826319134542584 - ], - "translation_xyz_cm": [ - 0.7606089908610336, - -1.1659696628856797, - -2.3826319134542584 - ], - "translation_norm_m": 0.02759519183980986, - "rotation_rpy_deg_xyz": [ - -1.385116990184271, - -0.9853339182123925, - 0.15034426343513776 - ], - "rotation_angle_deg": 1.7054047074838854, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.005376603699022819, - 0.005319793796464037, - 0.05418917513271009 - ], - "translation_xyz_cm": [ - 0.5376603699022819, - 0.5319793796464036, - 5.418917513271009 - ], - "translation_norm_m": 0.054714484142106, - "rotation_rpy_deg_xyz": [ - -0.4308911777566878, - -0.34521040255469665, - -0.1398630873000363 - ], - "rotation_angle_deg": 0.5698784993516836, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.012643413789746205, - -0.026722015486996264, - 0.021850547260248668 - ], - "translation_xyz_cm": [ - -1.2643413789746205, - -2.6722015486996264, - 2.185054726024867 - ], - "translation_norm_m": 0.03676096352815542, - "rotation_rpy_deg_xyz": [ - 0.8577116808307673, - -0.30739720316708374, - -0.2154598168400179 - ], - "rotation_angle_deg": 0.9357302365302121, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011328902283608056, - 0.02224672331629307, - 0.04342381591302455 - ], - "translation_xyz_cm": [ - -1.1328902283608056, - 2.224672331629307, - 4.342381591302455 - ], - "translation_norm_m": 0.0500888062715761, - "rotation_rpy_deg_xyz": [ - 0.06729818816186765, - 1.1457222242371556, - -0.2825962472174885 - ], - "rotation_angle_deg": 1.182136446890146, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004484398538715517, - -0.027870768543897473, - -0.06151977292289944 - ], - "translation_xyz_cm": [ - -0.04484398538715517, - -2.7870768543897473, - -6.151977292289944 - ], - "translation_norm_m": 0.0675400866005897, - "rotation_rpy_deg_xyz": [ - 0.3905197642995209, - 0.2567911565563081, - -0.08903191762278209 - ], - "rotation_angle_deg": 0.4759512535508281, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012573424581342252, - 0.012066614344569349, - -0.1278558418142467 - ], - "translation_xyz_cm": [ - 1.2573424581342252, - 1.2066614344569349, - -12.78558418142467 - ], - "translation_norm_m": 0.12903801948833896, - "rotation_rpy_deg_xyz": [ - -0.07048974789612959, - 0.5754780922057401, - -0.03569206639921093 - ], - "rotation_angle_deg": 0.5808549218282146, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0006077877190222569, - 0.02495549230853289, - -0.12628779625838185 - ], - "translation_xyz_cm": [ - -0.06077877190222569, - 2.495549230853289, - -12.628779625838185 - ], - "translation_norm_m": 0.12873132286305147, - "rotation_rpy_deg_xyz": [ - -0.17108386008126952, - 0.8875421507838345, - 0.21115703897639815 - ], - "rotation_angle_deg": 0.9285182528600985, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019899419133884377, - 0.02045104170115486, - -0.049224045955585036 - ], - "translation_xyz_cm": [ - -1.9899419133884377, - 2.045104170115486, - -4.922404595558503 - ], - "translation_norm_m": 0.05689673706607371, - "rotation_rpy_deg_xyz": [ - -0.08299275153517802, - 0.04474532771825442, - 0.07060939997673661 - ], - "rotation_angle_deg": 0.11781427540665272, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.033748560996567756, - 0.025235618505753177, - -0.0750153271637038 - ], - "translation_xyz_cm": [ - -3.3748560996567756, - 2.5235618505753177, - -7.501532716370379 - ], - "translation_norm_m": 0.08604127567734268, - "rotation_rpy_deg_xyz": [ - 0.12578705101663182, - 0.6067611808641802, - 0.3162554597696284 - ], - "rotation_angle_deg": 0.6953967411037035, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009180016499000021, - 0.014205476809026618, - -0.03425249776827852 - ], - "translation_xyz_cm": [ - -0.9180016499000021, - 1.4205476809026618, - -3.425249776827852 - ], - "translation_norm_m": 0.038200809908425115, - "rotation_rpy_deg_xyz": [ - 0.36339638463845925, - 0.6674216313953211, - 0.24725516606214024 - ], - "rotation_angle_deg": 0.7984952341151029, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.006054514429228552, - 0.0034015886546279184, - 0.0453624791916232 - ], - "translation_xyz_cm": [ - 0.6054514429228552, - 0.34015886546279184, - 4.53624791916232 - ], - "translation_norm_m": 0.0458909846130967, - "rotation_rpy_deg_xyz": [ - 1.1901840530526848, - -0.28584587514441945, - -0.2852596780269641 - ], - "rotation_angle_deg": 1.2561525340780257, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.013556640361261252, - 0.012118577492022053, - 0.013945473701008695 - ], - "translation_xyz_cm": [ - -1.3556640361261252, - 1.2118577492022053, - 1.3945473701008695 - ], - "translation_norm_m": 0.022915467594187257, - "rotation_rpy_deg_xyz": [ - 1.147462921939667, - 0.09186085077562536, - 0.3941478502599244 - ], - "rotation_angle_deg": 1.2164421401329297, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.019547380404213666, - 0.02141059776251053, - 0.08456611259126544 - ], - "translation_xyz_cm": [ - 1.9547380404213666, - 2.141059776251053, - 8.456611259126543 - ], - "translation_norm_m": 0.08939765755328066, - "rotation_rpy_deg_xyz": [ - 1.8124593081868325, - -0.46580172525214736, - -0.5104505081014582 - ], - "rotation_angle_deg": 1.9377763098142609, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.003028383876874763, - 0.013789257114170228, - 0.02228887330084775 - ], - "translation_xyz_cm": [ - 0.3028383876874763, - 1.3789257114170228, - 2.228887330084775 - ], - "translation_norm_m": 0.026383869952826346, - "rotation_rpy_deg_xyz": [ - 1.5367459351316461, - 0.2349353771667976, - 0.18908533251375984 - ], - "rotation_angle_deg": 1.565675248614791, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.005731986791654542, - 0.01328176450613805, - 0.008699435797877117 - ], - "translation_xyz_cm": [ - 0.5731986791654542, - 1.328176450613805, - 0.8699435797877118 - ], - "translation_norm_m": 0.0168801991747016, - "rotation_rpy_deg_xyz": [ - 0.665568569576474, - 0.7487338866459836, - -0.5061793832200092 - ], - "rotation_angle_deg": 1.1243625831862627, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00029534459282931635, - -0.01502268720780403, - 0.006473899975337739 - ], - "translation_xyz_cm": [ - -0.029534459282931635, - -1.502268720780403, - 0.6473899975337739 - ], - "translation_norm_m": 0.016360921131241674, - "rotation_rpy_deg_xyz": [ - -0.7564246250305294, - -0.2512173622136916, - -0.6997517983321957 - ], - "rotation_angle_deg": 1.0617216853586537, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005607982683432766, - 0.039529724683462386, - 0.06125749333411372 - ], - "translation_xyz_cm": [ - -0.5607982683432766, - 3.9529724683462386, - 6.125749333411372 - ], - "translation_norm_m": 0.07311996370969424, - "rotation_rpy_deg_xyz": [ - -1.241660734058652, - -0.5637973044846311, - 0.6116227635043595 - ], - "rotation_angle_deg": 1.4920349270168083, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.020951464549602505, - 0.022999110685020252, - 0.04441800053181093 - ], - "translation_xyz_cm": [ - 2.0951464549602505, - 2.299911068502025, - 4.441800053181093 - ], - "translation_norm_m": 0.05422989701556715, - "rotation_rpy_deg_xyz": [ - -0.3863502777535908, - -0.31141516637077304, - 0.49304271452082143 - ], - "rotation_angle_deg": 0.6987845408478884, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.009717995355081221, - -0.025907411159384386, - 0.02153823806292162 - ], - "translation_xyz_cm": [ - -0.9717995355081221, - -2.590741115938439, - 2.153823806292162 - ], - "translation_norm_m": 0.0350646415290084, - "rotation_rpy_deg_xyz": [ - 0.8090490947743006, - -0.744867737405382, - -0.12749884040411866 - ], - "rotation_angle_deg": 1.1064780128218634, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004731531518500365, - -0.000647962159230242, - 0.029562220615702947 - ], - "translation_xyz_cm": [ - -0.4731531518500365, - -0.0647962159230242, - 2.9562220615702945 - ], - "translation_norm_m": 0.02994548602380414, - "rotation_rpy_deg_xyz": [ - 0.49629952118216786, - -1.3066158998839483, - 0.23524671474336992 - ], - "rotation_angle_deg": 1.4182906758604152, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016591175846238038, - 0.006165105389012604, - 0.033487827139727255 - ], - "translation_xyz_cm": [ - -1.6591175846238038, - 0.6165105389012604, - 3.3487827139727253 - ], - "translation_norm_m": 0.03787756865162649, - "rotation_rpy_deg_xyz": [ - -0.7143759278915505, - -1.37460151036425, - 0.17568667889663378 - ], - "rotation_angle_deg": 1.5581048315237462, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.005049115681996619, - 0.017870082218921057, - -0.05187910077581297 - ], - "translation_xyz_cm": [ - 0.5049115681996619, - 1.7870082218921057, - -5.1879100775812965 - ], - "translation_norm_m": 0.05510240017447643, - "rotation_rpy_deg_xyz": [ - -0.2677790844912152, - -0.7198679579644974, - 0.0878280657811058 - ], - "rotation_angle_deg": 0.7728730407574438, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006324956966257345, - 0.002606988379937336, - -0.018629328651677983 - ], - "translation_xyz_cm": [ - -0.6324956966257345, - 0.2606988379937336, - -1.8629328651677983 - ], - "translation_norm_m": 0.019845738964582946, - "rotation_rpy_deg_xyz": [ - 0.07683111402387942, - -0.2815027483362668, - -0.05025715204936589 - ], - "rotation_angle_deg": 0.29606352391378077, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008936755123347462, - 0.02142789527811284, - -0.02421553863783999 - ], - "translation_xyz_cm": [ - 0.8936755123347462, - 2.142789527811284, - -2.4215538637839993 - ], - "translation_norm_m": 0.033547169771907276, - "rotation_rpy_deg_xyz": [ - 0.9689368388115391, - 0.11284882462038442, - -0.1475498246220297 - ], - "rotation_angle_deg": 0.9867244603067713, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014406424642980031, - 0.011427329253826835, - -0.024656381826506115 - ], - "translation_xyz_cm": [ - 1.4406424642980031, - 1.1427329253826835, - -2.4656381826506113 - ], - "translation_norm_m": 0.030758187359525756, - "rotation_rpy_deg_xyz": [ - 0.9539234585445359, - 0.19049617692008725, - -0.08084091865599398 - ], - "rotation_angle_deg": 0.9762424962060376, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0031501776785451963, - 0.0013919623940481518, - 0.02554577035837033 - ], - "translation_xyz_cm": [ - 0.3150177678545196, - 0.13919623940481518, - 2.554577035837033 - ], - "translation_norm_m": 0.02577688037593845, - "rotation_rpy_deg_xyz": [ - 1.2042230258076034, - -0.18340302290430344, - 0.020165104232538138 - ], - "rotation_angle_deg": 1.2183073803580622, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.014533210517364115, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.026002343812685902, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -0.00132483596826191, - 0.7204966196317207 - ], - "rotation_rpy_deg_xyz": [ - -0.6851396936080634, - 1.2041171781580922, - -0.833409656117373 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.09944242267101946, - "median": 0.05419097262145875, - "p90": 0.1580606772626095, - "p95": 0.2197177341851549, - "max": 0.32692858463011104 - }, - "rotation_deg": { - "rms": 1.0271293323765827, - "median": 0.8035827496102723, - "p90": 1.5776574478796102, - "p95": 1.8106326881075614, - "max": 2.183094307956349 - }, - "normalized_pair_score": { - "rms": 2.859282573021794, - "median": 2.466981098762025, - "p90": 4.40287163715159, - "p95": 4.954027145137866, - "max": 6.564536977615282 - }, - "normalized_global_rms": 2.859282573021794 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012870874514109953, - 0.014250677001946932, - 0.07813974310806714 - ], - "translation_xyz_cm": [ - -1.2870874514109953, - 1.4250677001946932, - 7.813974310806714 - ], - "translation_norm_m": 0.08046465471725153, - "rotation_rpy_deg_xyz": [ - -0.5325608840306802, - -0.132100359937178, - 0.024650758909434137 - ], - "rotation_angle_deg": 0.5492256932471735, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.652705907802981, - "median": 0.7642140295928858, - "p90": 2.3730818708821753, - "p95": 3.9393965271141544, - "max": 5.432408856778532 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012870874514109953, - 0.014250677001946932, - 0.07813974310806714 - ], - "translation_xyz_cm": [ - -1.2870874514109953, - 1.4250677001946932, - 7.813974310806714 - ], - "translation_norm_m": 0.08046465471725153, - "rotation_rpy_deg_xyz": [ - -0.5325608840306802, - -0.132100359937178, - 0.024650758909434137 - ], - "rotation_angle_deg": 0.5492256932471735, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019849501771051492, - -0.014225119869694547, - 0.13388568757836983 - ], - "translation_xyz_cm": [ - 1.9849501771051492, - -1.4225119869694547, - 13.388568757836982 - ], - "translation_norm_m": 0.13609457775458583, - "rotation_rpy_deg_xyz": [ - -0.30814802989837486, - -0.2553853612285898, - -0.3465566070631916 - ], - "rotation_angle_deg": 0.5298619890141043, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03171040067575015, - 0.009422119895287961, - 0.11079741994972288 - ], - "translation_xyz_cm": [ - 3.171040067575015, - 0.9422119895287961, - 11.079741994972288 - ], - "translation_norm_m": 0.11563042039988027, - "rotation_rpy_deg_xyz": [ - -0.25199339672410914, - -0.3608228159641627, - -0.4025035401863851 - ], - "rotation_angle_deg": 0.5969427266670555, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034046736055924454, - -0.018218222792134975, - 0.048844107601041756 - ], - "translation_xyz_cm": [ - 3.4046736055924454, - -1.8218222792134975, - 4.884410760104176 - ], - "translation_norm_m": 0.06226420099148304, - "rotation_rpy_deg_xyz": [ - 0.2559468722643658, - 0.0559290578346524, - -0.3518306890513121 - ], - "rotation_angle_deg": 0.4387589038931823, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.045183224004385236, - 0.0124474119700132, - 0.027143963448575968 - ], - "translation_xyz_cm": [ - 4.518322400438524, - 1.24474119700132, - 2.714396344857597 - ], - "translation_norm_m": 0.05415954715356573, - "rotation_rpy_deg_xyz": [ - 0.37278014805454507, - 0.19905149467537275, - -0.38525812242251006 - ], - "rotation_angle_deg": 0.5722835691407653, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.011021727169430146, - 0.010131317540239992, - -0.0287389794000784 - ], - "translation_xyz_cm": [ - 1.1021727169430147, - 1.0131317540239992, - -2.87389794000784 - ], - "translation_norm_m": 0.03240449045821674, - "rotation_rpy_deg_xyz": [ - 0.5413261916098648, - 0.00692556911784763, - 0.12837339237070147 - ], - "rotation_angle_deg": 0.5563750662778144, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.004848507119116668, - 0.021274477483793436, - -0.009151694612596507 - ], - "translation_xyz_cm": [ - 0.4848507119116668, - 2.1274477483793435, - -0.9151694612596507 - ], - "translation_norm_m": 0.02366146503864008, - "rotation_rpy_deg_xyz": [ - 0.2566485820405728, - 0.17867899954417002, - -0.03495353671788429 - ], - "rotation_angle_deg": 0.31471312103176363, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.034484381660623405, - 0.0007872247001593502, - -0.06967327514946207 - ], - "translation_xyz_cm": [ - -3.4484381660623407, - 0.07872247001593502, - -6.9673275149462075 - ], - "translation_norm_m": 0.07774418030500245, - "rotation_rpy_deg_xyz": [ - 0.5530457420079644, - 0.38237454735918597, - 0.530152881090796 - ], - "rotation_angle_deg": 0.8550853084401805, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0331459140849214, - -0.01671063895985936, - -0.12662434558289104 - ], - "translation_xyz_cm": [ - -3.31459140849214, - -1.6710638959859359, - -12.662434558289103 - ], - "translation_norm_m": 0.13195310518993927, - "rotation_rpy_deg_xyz": [ - 0.6600428803164113, - 0.13399713556597315, - 0.3933083515652571 - ], - "rotation_angle_deg": 0.7795474268257585, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03255708121599314, - -0.019712782578652582, - -0.050083477735733926 - ], - "translation_xyz_cm": [ - -3.255708121599314, - -1.9712782578652583, - -5.008347773573393 - ], - "translation_norm_m": 0.06290399094178173, - "rotation_rpy_deg_xyz": [ - 0.4597898106813386, - 0.27041855418523675, - 0.5831477058430078 - ], - "rotation_angle_deg": 0.7895098434536542, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04010277096262335, - -0.037361836537912085, - -0.07513426564667143 - ], - "translation_xyz_cm": [ - -4.010277096262335, - -3.7361836537912083, - -7.513426564667143 - ], - "translation_norm_m": 0.09300159645205495, - "rotation_rpy_deg_xyz": [ - 0.6206183263311692, - 0.6411119815189987, - 0.4968198522178069 - ], - "rotation_angle_deg": 1.0195893846213122, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013910624897495366, - -0.00998170162076506, - -0.029736917394995493 - ], - "translation_xyz_cm": [ - -1.3910624897495367, - -0.998170162076506, - -2.9736917394995492 - ], - "translation_norm_m": 0.034313614039351605, - "rotation_rpy_deg_xyz": [ - 0.3102778161135205, - 0.227067374414036, - -0.08896703136558141 - ], - "rotation_angle_deg": 0.39478638692398543, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009381914466719599, - -0.002130936792771168, - -0.21095784653879324 - ], - "translation_xyz_cm": [ - 0.9381914466719599, - -0.2130936792771168, - -21.095784653879324 - ], - "translation_norm_m": 0.2111771157747938, - "rotation_rpy_deg_xyz": [ - -0.0330460078804258, - -0.1472631972697264, - 0.2916106213693062 - ], - "rotation_angle_deg": 0.3283145206350488, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.008052886256739167, - 0.018189435919574205, - -0.19579001087291684 - ], - "translation_xyz_cm": [ - 0.8052886256739167, - 1.8189435919574206, - -19.579001087291683 - ], - "translation_norm_m": 0.19679794946531623, - "rotation_rpy_deg_xyz": [ - 0.05529631141507743, - -0.3086183774601124, - 0.3952998980225105 - ], - "rotation_angle_deg": 0.5046606151295715, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.010265887249026773, - 0.006297488019886999, - -0.1311301897657054 - ], - "translation_xyz_cm": [ - -1.0265887249026773, - 0.6297488019886999, - -13.11301897657054 - ], - "translation_norm_m": 0.13168209242095244, - "rotation_rpy_deg_xyz": [ - 0.5121264842734488, - -0.6166939224051967, - -0.10076748495008415 - ], - "rotation_angle_deg": 0.807577159501199, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.007191226776678716, - 0.015959048435487122, - -0.12994968731393539 - ], - "translation_xyz_cm": [ - 0.7191226776678716, - 1.5959048435487122, - -12.994968731393538 - ], - "translation_norm_m": 0.13112332440305738, - "rotation_rpy_deg_xyz": [ - -0.8305893633959313, - 0.6160705168776986, - 0.2906845636353352 - ], - "rotation_angle_deg": 1.0754097896643824, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.01243804602309323, - -0.001383579663629897, - -0.054188654364886284 - ], - "translation_xyz_cm": [ - -1.243804602309323, - -0.1383579663629897, - -5.418865436488629 - ], - "translation_norm_m": 0.05561501185323352, - "rotation_rpy_deg_xyz": [ - -0.7689277256702551, - 0.05538810834444157, - -0.2125618819842679 - ], - "rotation_angle_deg": 0.7995883397193455, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.009679278943592662, - -0.018585517343530603, - 0.06903199490734244 - ], - "translation_xyz_cm": [ - -0.9679278943592662, - -1.8585517343530602, - 6.903199490734243 - ], - "translation_norm_m": 0.07214240234897855, - "rotation_rpy_deg_xyz": [ - 0.26378245948903, - -0.443809070672506, - -0.48628593696357475 - ], - "rotation_angle_deg": 0.7085380318985388, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.00041195648836467313, - -0.0013726150113285707, - 0.0026396275875124574 - ], - "translation_xyz_cm": [ - -0.04119564883646731, - -0.13726150113285707, - 0.26396275875124575 - ], - "translation_norm_m": 0.0030035668659757057, - "rotation_rpy_deg_xyz": [ - 0.146486325570272, - -0.41959318572956505, - -0.4814594892834861 - ], - "rotation_angle_deg": 0.6548298831900574, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.002274976428522202, - 0.01574187444705455, - -0.06570544890781521 - ], - "translation_xyz_cm": [ - 0.22749764285222018, - 1.574187444705455, - -6.570544890781521 - ], - "translation_norm_m": 0.06760316667904452, - "rotation_rpy_deg_xyz": [ - -0.7338509501782113, - -0.5227647813553995, - -0.3083398424654438 - ], - "rotation_angle_deg": 0.9533900182703924, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.009672212516376455, - 0.020617811833847255, - -0.059947857623197015 - ], - "translation_xyz_cm": [ - 0.9672212516376455, - 2.0617811833847255, - -5.994785762319702 - ], - "translation_norm_m": 0.06412793068070247, - "rotation_rpy_deg_xyz": [ - 0.05444269237917539, - -0.01851396790708448, - 0.005409706346117727 - ], - "rotation_angle_deg": 0.05775927478328968, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011177358228270151, - 0.04043414039103732, - -0.10512749640195788 - ], - "translation_xyz_cm": [ - 1.1177358228270151, - 4.043414039103732, - -10.51274964019579 - ], - "translation_norm_m": 0.11318853098202512, - "rotation_rpy_deg_xyz": [ - -0.9403656569245651, - -0.27318173898733006, - 0.16698853380712517 - ], - "rotation_angle_deg": 0.9930004731694305, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006000298362307921, - 0.01692175179142985, - -0.049748626679505414 - ], - "translation_xyz_cm": [ - 0.6000298362307921, - 1.692175179142985, - -4.974862667950541 - ], - "translation_norm_m": 0.05288927226408274, - "rotation_rpy_deg_xyz": [ - -0.9475740693291651, - -0.11673004617688458, - 0.16514888159537355 - ], - "rotation_angle_deg": 0.9687501791312266, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0035429245126745723, - -0.01607829615065892, - -0.15400676343476893 - ], - "translation_xyz_cm": [ - -0.35429245126745723, - -1.6078296150658922, - -15.400676343476894 - ], - "translation_norm_m": 0.15488430231906553, - "rotation_rpy_deg_xyz": [ - -0.5415441730844602, - 1.5276449607055649, - -0.3354456236023479 - ], - "rotation_angle_deg": 1.6536700533705546, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.004227882143667316, - 0.012379634760789293, - -0.031464218006119184 - ], - "translation_xyz_cm": [ - -0.42278821436673164, - 1.2379634760789293, - -3.1464218006119182 - ], - "translation_norm_m": 0.034075318912196235, - "rotation_rpy_deg_xyz": [ - 0.5120968181546444, - 0.33610263480894265, - 0.20060721427366796 - ], - "rotation_angle_deg": 0.6440866598072778, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.012101209377714861, - 0.021587872516164452, - -0.024105891730171802 - ], - "translation_xyz_cm": [ - 1.210120937771486, - 2.1587872516164452, - -2.41058917301718 - ], - "translation_norm_m": 0.03454807555109586, - "rotation_rpy_deg_xyz": [ - 0.6888086262602262, - 0.7924027415302516, - 0.18932208308063866 - ], - "rotation_angle_deg": 1.066016034037837, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.010244586142522216, - 0.005277915796129573, - -0.009097816364618226 - ], - "translation_xyz_cm": [ - -1.0244586142522216, - 0.5277915796129573, - -0.9097816364618226 - ], - "translation_norm_m": 0.014682581618601937, - "rotation_rpy_deg_xyz": [ - -0.4089733929482786, - 1.922173494834221, - 0.6383894475312755 - ], - "rotation_angle_deg": 2.0683941955984535, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015411116834146865, - 0.015199364673567639, - -0.0007053728290768169 - ], - "translation_xyz_cm": [ - 1.5411116834146865, - 1.519936467356764, - -0.07053728290768169 - ], - "translation_norm_m": 0.02165688711204407, - "rotation_rpy_deg_xyz": [ - 0.3183715884940551, - 0.23120245382882412, - -0.014534648029192179 - ], - "rotation_angle_deg": 0.39375732806551234, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.004937683582914909, - 0.008033115242936484, - 0.02311811884494326 - ], - "translation_xyz_cm": [ - -0.4937683582914909, - 0.8033115242936484, - 2.3118118844943263 - ], - "translation_norm_m": 0.024967160002695672, - "rotation_rpy_deg_xyz": [ - 0.042018351304118705, - 1.4440930127863265, - 0.4754869621153203 - ], - "rotation_angle_deg": 1.5207703283318257, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.009343561645531517, - 0.006703332207666168, - 0.24439046980098492 - ], - "translation_xyz_cm": [ - 0.9343561645531517, - 0.6703332207666168, - 24.439046980098492 - ], - "translation_norm_m": 0.2446608643335838, - "rotation_rpy_deg_xyz": [ - -0.026287077448226302, - -0.3986316081909531, - -0.2905833052012495 - ], - "rotation_angle_deg": 0.4940542751855222, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0016426099916251324, - -0.0070332759279690404, - 0.03190390380828259 - ], - "translation_xyz_cm": [ - 0.16426099916251324, - -0.703327592796904, - 3.190390380828259 - ], - "translation_norm_m": 0.03271122461895433, - "rotation_rpy_deg_xyz": [ - 0.2752170989812519, - 1.2310635743245315, - 0.5142347360325037 - ], - "rotation_angle_deg": 1.361118986706042, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.029696436167651385, - -0.008016651585637913, - 0.2290313317722948 - ], - "translation_xyz_cm": [ - 2.9696436167651385, - -0.8016651585637913, - 22.903133177229478 - ], - "translation_norm_m": 0.2310876369628974, - "rotation_rpy_deg_xyz": [ - 0.29618228304264616, - -0.6054154344304503, - -0.25128457238015406 - ], - "rotation_angle_deg": 0.7187543132684605, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.02781850623983484, - 0.0049688793212467885, - 0.3257049898253369 - ], - "translation_xyz_cm": [ - 2.781850623983484, - 0.49688793212467885, - 32.57049898253369 - ], - "translation_norm_m": 0.32692858463011104, - "rotation_rpy_deg_xyz": [ - -0.08380596513928225, - 0.15930696295598848, - -0.22958197636035627 - ], - "rotation_angle_deg": 0.2916444544215273, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006386207465875815, - 0.01371409880247998, - 0.16052578251598237 - ], - "translation_xyz_cm": [ - 0.6386207465875815, - 1.371409880247998, - 16.052578251598238 - ], - "translation_norm_m": 0.16123705220615347, - "rotation_rpy_deg_xyz": [ - 0.9042912179366549, - -1.5378183236048404, - -0.7453624162746609 - ], - "rotation_angle_deg": 1.928732263166145, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.01430848913479954, - 0.02617641385263214, - 0.2205562666996539 - ], - "translation_xyz_cm": [ - -1.430848913479954, - 2.617641385263214, - 22.05562666996539 - ], - "translation_norm_m": 0.22256460698860858, - "rotation_rpy_deg_xyz": [ - 0.7841459701425789, - -0.5574209938545415, - -0.7003096739248279 - ], - "rotation_angle_deg": 1.1877195770910876, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0020713869038755384, - -0.011253943041440229, - 0.11263307656233998 - ], - "translation_xyz_cm": [ - 0.20713869038755384, - -1.1253943041440229, - 11.263307656233998 - ], - "translation_norm_m": 0.11321286063687053, - "rotation_rpy_deg_xyz": [ - -0.7081953633062871, - 0.5752294249066399, - 0.00473121871785103 - ], - "rotation_angle_deg": 0.9124041726282158, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0009537930911136527, - -0.0038274981851991186, - -0.03801437221635509 - ], - "translation_xyz_cm": [ - -0.09537930911136527, - -0.38274981851991186, - -3.801437221635509 - ], - "translation_norm_m": 0.03821847666537677, - "rotation_rpy_deg_xyz": [ - -0.4887610929731296, - 0.5026091908766562, - 0.0900560597482801 - ], - "rotation_angle_deg": 0.7071053536689378, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.001466777115332718, - 0.02738015603570676, - 0.04677867115379 - ], - "translation_xyz_cm": [ - -0.1466777115332718, - 2.738015603570676, - 4.677867115379001 - ], - "translation_norm_m": 0.05422239808935177, - "rotation_rpy_deg_xyz": [ - -0.8201055585745557, - -0.168902858691228, - -0.7397105897258652 - ], - "rotation_angle_deg": 1.118056866682163, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012335445245211574, - -0.04057733084861148, - -0.01198019357752817 - ], - "translation_xyz_cm": [ - 1.2335445245211574, - -4.057733084861148, - -1.1980193577528169 - ], - "translation_norm_m": 0.04407048929102486, - "rotation_rpy_deg_xyz": [ - 0.14129867456026288, - -0.051731509814885106, - -0.6473485755879164 - ], - "rotation_angle_deg": 0.6645440648996449, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.00122337983681442, - 0.013693159027025281, - 0.0070610496605975764 - ], - "translation_xyz_cm": [ - 0.122337983681442, - 1.3693159027025281, - 0.7061049660597576 - ], - "translation_norm_m": 0.01545502134175017, - "rotation_rpy_deg_xyz": [ - -0.08399806690115384, - 0.030048309304347143, - 0.14220262399867495 - ], - "rotation_angle_deg": 0.1678881249096884, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.0060419819554002885, - -0.012003428306194663, - -0.017683158201969085 - ], - "translation_xyz_cm": [ - 0.6041981955400288, - -1.2003428306194663, - -1.7683158201969085 - ], - "translation_norm_m": 0.02220995094652855, - "rotation_rpy_deg_xyz": [ - -1.3533217857456405, - -1.0906978392006157, - 0.15208684615746604 - ], - "rotation_angle_deg": 1.7436332376803183, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0025879627902243296, - 0.0034435310238590255, - 0.058854201051244344 - ], - "translation_xyz_cm": [ - 0.25879627902243296, - 0.34435310238590255, - 5.885420105124434 - ], - "translation_norm_m": 0.05901162969022425, - "rotation_rpy_deg_xyz": [ - -0.27916531777482795, - -0.5364160981949373, - -0.1381128345218774 - ], - "rotation_angle_deg": 0.6205730309625402, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.013362478307735515, - -0.031966449102918904, - 0.025848705286129717 - ], - "translation_xyz_cm": [ - -1.3362478307735515, - -3.1966449102918904, - 2.5848705286129716 - ], - "translation_norm_m": 0.043226904350686476, - "rotation_rpy_deg_xyz": [ - 1.2520174008990141, - -0.35149897142138253, - -0.20859355944335656 - ], - "rotation_angle_deg": 1.316435111493718, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.013233207502184818, - 0.021658658658626262, - 0.04811095260134757 - ], - "translation_xyz_cm": [ - -1.3233207502184818, - 2.165865865862626, - 4.811095260134756 - ], - "translation_norm_m": 0.054395579194415046, - "rotation_rpy_deg_xyz": [ - 0.12363392818794307, - 1.0094417166502565, - -0.28350797755827994 - ], - "rotation_angle_deg": 1.0560538481567812, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0030482170676493503, - -0.030689363671338565, - -0.05012233379164305 - ], - "translation_xyz_cm": [ - -0.30482170676493503, - -3.0689363671338565, - -5.012233379164305 - ], - "translation_norm_m": 0.05885046316354755, - "rotation_rpy_deg_xyz": [ - 0.5948424254966925, - 0.059709044671339154, - -0.08913753781674988 - ], - "rotation_angle_deg": 0.6044860079470344, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.011576057053633626, - 0.0072142293234276345, - -0.11104283880764719 - ], - "translation_xyz_cm": [ - 1.1576057053633626, - 0.7214229323427634, - -11.104283880764719 - ], - "translation_norm_m": 0.11187744299947644, - "rotation_rpy_deg_xyz": [ - 0.3149640144373868, - 0.5034970122705597, - -0.02874017419155929 - ], - "rotation_angle_deg": 0.594656598990126, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0002758594350642518, - 0.02008746686099716, - -0.11265698679376861 - ], - "translation_xyz_cm": [ - -0.02758594350642518, - 2.008746686099716, - -11.265698679376861 - ], - "translation_norm_m": 0.11443416927111819, - "rotation_rpy_deg_xyz": [ - 0.2263849153128078, - 0.9222462332712891, - 0.21999263175538472 - ], - "rotation_angle_deg": 0.9743619180539599, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.02210238881273008, - 0.018763270783825114, - -0.04506933872788373 - ], - "translation_xyz_cm": [ - -2.210238881273008, - 1.8763270783825114, - -4.506933872788373 - ], - "translation_norm_m": 0.05358937595368098, - "rotation_rpy_deg_xyz": [ - 0.040815904615290846, - -0.13729541068995801, - 0.07078107333079628 - ], - "rotation_angle_deg": 0.15979001086589728, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03597995533668663, - 0.022318091205329793, - -0.0726118570796889 - ], - "translation_xyz_cm": [ - -3.597995533668663, - 2.2318091205329793, - -7.26118570796889 - ], - "translation_norm_m": 0.08405436436997517, - "rotation_rpy_deg_xyz": [ - 0.35618150382014435, - 0.4119544610244835, - 0.31760355603095375 - ], - "rotation_angle_deg": 0.6297849582040155, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010472543065393247, - 0.013735207746829459, - -0.03200700620779637 - ], - "translation_xyz_cm": [ - -1.0472543065393247, - 1.3735207746829459, - -3.200700620779637 - ], - "translation_norm_m": 0.03637002249780711, - "rotation_rpy_deg_xyz": [ - 0.393691354318348, - 0.5644454148447818, - 0.24579977190975077 - ], - "rotation_angle_deg": 0.730105294658624, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.003916851645858532, - -0.00048227348370311063, - 0.044909375477078975 - ], - "translation_xyz_cm": [ - 0.39168516458585323, - -0.04822734837031106, - 4.490937547707897 - ], - "translation_norm_m": 0.04508243915617266, - "rotation_rpy_deg_xyz": [ - 1.4983806857899884, - -0.4512037738909708, - -0.28493351139568235 - ], - "rotation_angle_deg": 1.589508679287657, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.015068737106081809, - 0.007136663162194301, - 0.023877621934465465 - ], - "translation_xyz_cm": [ - -1.5068737106081809, - 0.7136663162194301, - 2.3877621934465463 - ], - "translation_norm_m": 0.029122836886335338, - "rotation_rpy_deg_xyz": [ - 1.5142786009379081, - -0.01561244373027908, - 0.3978828123183685 - ], - "rotation_angle_deg": 1.5658062164715634, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.017222593882413317, - 0.019263446473488433, - 0.07553424646638578 - ], - "translation_xyz_cm": [ - 1.7222593882413317, - 1.9263446473488433, - 7.553424646638578 - ], - "translation_norm_m": 0.07983182635591025, - "rotation_rpy_deg_xyz": [ - 2.0181836165293427, - -0.6627875689019732, - -0.5154193572388455 - ], - "rotation_angle_deg": 2.183094307956349, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0006197808120580461, - 0.009805741283602565, - 0.030761986961937396 - ], - "translation_xyz_cm": [ - 0.061978081205804614, - 0.9805741283602565, - 3.0761986961937398 - ], - "translation_norm_m": 0.032292979612020156, - "rotation_rpy_deg_xyz": [ - 1.82255570449965, - 0.05714387021955363, - 0.18743798299891448 - ], - "rotation_angle_deg": 1.8329658382499758, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0041161809153633655, - 0.00833703704333666, - 0.01905445417864772 - ], - "translation_xyz_cm": [ - 0.41161809153633655, - 0.8337037043336659, - 1.905445417864772 - ], - "translation_norm_m": 0.021201918687613033, - "rotation_rpy_deg_xyz": [ - 1.0289910942817144, - 0.6362507122401511, - -0.5017532590073943 - ], - "rotation_angle_deg": 1.3119097059409317, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0016534054296493128, - -0.015278722339962303, - 0.009662148951511428 - ], - "translation_xyz_cm": [ - -0.16534054296493128, - -1.5278722339962303, - 0.9662148951511428 - ], - "translation_norm_m": 0.018152967476907193, - "rotation_rpy_deg_xyz": [ - -0.7292729296631733, - -0.34896811115819215, - -0.6992538993004338 - ], - "rotation_angle_deg": 1.0703597114785428, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00399653435270686, - 0.03926719918564536, - 0.05073249947913065 - ], - "translation_xyz_cm": [ - -0.399653435270686, - 3.9267199185645363, - 5.073249947913065 - ], - "translation_norm_m": 0.0642780811950505, - "rotation_rpy_deg_xyz": [ - -1.2175190343481954, - -0.4655782787448729, - 0.6113676460691083 - ], - "rotation_angle_deg": 1.43764159128075, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02394546482894988, - 0.02140714709820024, - 0.02709210927218765 - ], - "translation_xyz_cm": [ - 2.394546482894988, - 2.140714709820024, - 2.709210927218765 - ], - "translation_norm_m": 0.04201944332775739, - "rotation_rpy_deg_xyz": [ - -0.24392209919550858, - -0.11697433807852226, - 0.4976283574490649 - ], - "rotation_angle_deg": 0.5661860777216423, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.007764306979268776, - -0.02647052677106232, - 0.016119361419806848 - ], - "translation_xyz_cm": [ - -0.7764306979268776, - -2.647052677106232, - 1.6119361419806848 - ], - "translation_norm_m": 0.03195007140818634, - "rotation_rpy_deg_xyz": [ - 0.8650813531793715, - -0.6031150874985503, - -0.12230589882880828 - ], - "rotation_angle_deg": 1.0611084872304541, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.002914070482875619, - -0.0010403466687580742, - 0.024017951765459428 - ], - "translation_xyz_cm": [ - -0.2914070482875619, - -0.10403466687580742, - 2.4017951765459427 - ], - "translation_norm_m": 0.024216443483267697, - "rotation_rpy_deg_xyz": [ - 0.5381161438563082, - -1.18122318248681, - 0.23897812117449893 - ], - "rotation_angle_deg": 1.3208354328670546, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.013685425455202793, - 0.0037797437792899125, - 0.024334491041600292 - ], - "translation_xyz_cm": [ - -1.3685425455202793, - 0.37797437792899125, - 2.4334491041600295 - ], - "translation_norm_m": 0.02817347666122728, - "rotation_rpy_deg_xyz": [ - -0.5221298987219626, - -1.1718417327434323, - 0.18031652784155 - ], - "rotation_angle_deg": 1.2947626390058276, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007164148152440153, - 0.014185015837851367, - -0.05104134568688994 - ], - "translation_xyz_cm": [ - 0.7164148152440153, - 1.4185015837851367, - -5.104134568688994 - ], - "translation_norm_m": 0.0534580084047171, - "rotation_rpy_deg_xyz": [ - 0.029034605698425885, - -0.5421285997962119, - 0.09612747436081819 - ], - "rotation_angle_deg": 0.551373966930815, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.004294608879272577, - 0.0017823689306075696, - -0.02383106684546112 - ], - "translation_xyz_cm": [ - -0.4294608879272577, - 0.17823689306075696, - -2.383106684546112 - ], - "translation_norm_m": 0.024280449983959486, - "rotation_rpy_deg_xyz": [ - 0.14612143402575795, - -0.12720760782925722, - -0.04638723976593878 - ], - "rotation_angle_deg": 0.19917320434172409, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011270820838496842, - 0.0191911378546894, - -0.02062055773395971 - ], - "translation_xyz_cm": [ - 1.1270820838496842, - 1.91911378546894, - -2.0620557733959712 - ], - "translation_norm_m": 0.030340378636245672, - "rotation_rpy_deg_xyz": [ - 1.1355389163061824, - 0.31274551162313063, - -0.1376386007352406 - ], - "rotation_angle_deg": 1.186192236689091, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0156495326622621, - 0.010968728778377623, - -0.022830824136267577 - ], - "translation_xyz_cm": [ - 1.56495326622621, - 1.0968728778377623, - -2.2830824136267576 - ], - "translation_norm_m": 0.029773602642307093, - "rotation_rpy_deg_xyz": [ - 0.9813182019632221, - 0.29439766155096103, - -0.0770863304192468 - ], - "rotation_angle_deg": 1.0276108738266783, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004280670362076577, - 0.0012480724976401403, - 0.024407256277881144 - ], - "translation_xyz_cm": [ - 0.42806703620765774, - 0.12480724976401403, - 2.4407256277881144 - ], - "translation_norm_m": 0.024811206796975738, - "rotation_rpy_deg_xyz": [ - 1.2223365153658456, - -0.09730865905399282, - 0.023549905487150028 - ], - "rotation_angle_deg": 1.2264496069558513, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0036411815791459468, - "improved_pairs": 38, - "worsened_pairs": 28, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.014602177580218312, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152137045299, - 0.0024476764333135033, - 0.7182275658581914 - ], - "rotation_rpy_deg_xyz": [ - -0.9866396137764585, - 1.299726385041302, - -0.8397351699715397 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10256719458254226, - "median": 0.05538973793123575, - "p90": 0.16013818600872365, - "p95": 0.21655126019956425, - "max": 0.3418289723590301 - }, - "rotation_deg": { - "rms": 1.0458160126880083, - "median": 0.8768354339460169, - "p90": 1.6489889292075672, - "p95": 1.825777727463781, - "max": 2.535152977471376 - }, - "normalized_pair_score": { - "rms": 2.929664876976855, - "median": 2.427836647146794, - "p90": 4.506920958383597, - "p95": 4.903264538319449, - "max": 7.016978231565398 - }, - "normalized_global_rms": 2.929664876976855 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01193812860126059, - 0.013660076079552774, - 0.07512140390059938 - ], - "translation_xyz_cm": [ - -1.193812860126059, - 1.3660076079552774, - 7.512140390059938 - ], - "translation_norm_m": 0.07728092854641688, - "rotation_rpy_deg_xyz": [ - -0.5186976328956353, - -0.06075494068745601, - 0.025340093543245994 - ], - "rotation_angle_deg": 0.5228446714705329, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7058242505297496, - "median": 0.6958135424032661, - "p90": 2.316636492319242, - "p95": 3.9421963521214107, - "max": 5.747677749152345 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01193812860126059, - 0.013660076079552774, - 0.07512140390059938 - ], - "translation_xyz_cm": [ - -1.193812860126059, - 1.3660076079552774, - 7.512140390059938 - ], - "translation_norm_m": 0.07728092854641688, - "rotation_rpy_deg_xyz": [ - -0.5186976328956353, - -0.06075494068745601, - 0.025340093543245994 - ], - "rotation_angle_deg": 0.5228446714705329, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021872302193916227, - -0.015032568685410475, - 0.12910289996150243 - ], - "translation_xyz_cm": [ - 2.1872302193916227, - -1.5032568685410475, - 12.910289996150242 - ], - "translation_norm_m": 0.13180263465884617, - "rotation_rpy_deg_xyz": [ - -0.2970010410852404, - -0.11190881242044907, - -0.3449773488089977 - ], - "rotation_angle_deg": 0.4689801268726104, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03498370747598811, - 0.008951795248228978, - 0.10496774524476647 - ], - "translation_xyz_cm": [ - 3.4983707475988113, - 0.8951795248228978, - 10.496774524476647 - ], - "translation_norm_m": 0.11100550422705135, - "rotation_rpy_deg_xyz": [ - -0.26486001450683555, - -0.13588063496860622, - -0.40051735698137125 - ], - "rotation_angle_deg": 0.49927919220838957, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03496452832672825, - -0.018619776612753602, - 0.04623233875336642 - ], - "translation_xyz_cm": [ - 3.496452832672825, - -1.8619776612753602, - 4.623233875336642 - ], - "translation_norm_m": 0.06088220978927633, - "rotation_rpy_deg_xyz": [ - 0.2697752888100495, - 0.12676116120303882, - -0.35016998967932783 - ], - "rotation_angle_deg": 0.46008131139835645, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.047255567120638164, - 0.012107973161620822, - 0.023376992584938715 - ], - "translation_xyz_cm": [ - 4.725556712063817, - 1.2107973161620822, - 2.3376992584938714 - ], - "translation_norm_m": 0.054094134804911605, - "rotation_rpy_deg_xyz": [ - 0.3818429301188199, - 0.3546605456646198, - -0.38176494558513185 - ], - "rotation_angle_deg": 0.6467097270108282, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.014909700050441094, - 0.010925927117361178, - -0.03277810288064673 - ], - "translation_xyz_cm": [ - 1.4909700050441095, - 1.0925927117361178, - -3.277810288064673 - ], - "translation_norm_m": 0.03763082602630818, - "rotation_rpy_deg_xyz": [ - 0.4817019128960827, - 0.3063098921558084, - 0.13411148975811377 - ], - "rotation_angle_deg": 0.5860906966123542, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00591999729698226, - 0.021089978234940077, - -0.010334661013449348 - ], - "translation_xyz_cm": [ - 0.591999729698226, - 2.1089978234940077, - -1.0334661013449349 - ], - "translation_norm_m": 0.02422062691611085, - "rotation_rpy_deg_xyz": [ - 0.27122689110868015, - 0.26232951774372587, - -0.033029119834606026 - ], - "rotation_angle_deg": 0.3788305805197378, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031547376724226785, - 0.0012796843004821978, - -0.07142133246324403 - ], - "translation_xyz_cm": [ - -3.1547376724226783, - 0.12796843004821978, - -7.142133246324403 - ], - "translation_norm_m": 0.07808893200008835, - "rotation_rpy_deg_xyz": [ - 0.5333686544895924, - 0.6216102263213674, - 0.5354813710167988 - ], - "rotation_angle_deg": 0.9769930434417843, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.029272718101028855, - -0.015423886219011806, - -0.12940469950212086 - ], - "translation_xyz_cm": [ - -2.9272718101028854, - -1.5423886219011806, - -12.940469950212085 - ], - "translation_norm_m": 0.13356782750480567, - "rotation_rpy_deg_xyz": [ - 0.5808325829721618, - 0.45458557766404306, - 0.3997264768640761 - ], - "rotation_angle_deg": 0.8378244109757887, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.030589018497878373, - -0.01956294097102318, - -0.05091698877353057 - ], - "translation_xyz_cm": [ - -3.058901849787837, - -1.956294097102318, - -5.091698877353057 - ], - "translation_norm_m": 0.06253748042464712, - "rotation_rpy_deg_xyz": [ - 0.46816353767120233, - 0.4295127232043098, - 0.5869402857446643 - ], - "rotation_angle_deg": 0.8637665922441115, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03705477865138075, - -0.03668153959872644, - -0.0771926541426014 - ], - "translation_xyz_cm": [ - -3.705477865138075, - -3.6681539598726443, - -7.71926541426014 - ], - "translation_norm_m": 0.0931520145880648, - "rotation_rpy_deg_xyz": [ - 0.5933203855673373, - 0.8944497464837455, - 0.5026029737462928 - ], - "rotation_angle_deg": 1.183219904212373, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01263738333154036, - -0.010066511952241064, - -0.0309941871296455 - ], - "translation_xyz_cm": [ - -1.263738333154036, - -1.0066511952241064, - -3.09941871296455 - ], - "translation_norm_m": 0.03495250715156767, - "rotation_rpy_deg_xyz": [ - 0.3250585990923554, - 0.3267621302031689, - -0.0866367111243534 - ], - "rotation_angle_deg": 0.4691511328658994, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012881539719806268, - 0.0001735749980262269, - -0.20938972368366968 - ], - "translation_xyz_cm": [ - 1.2881539719806268, - 0.01735749980262269, - -20.93897236836697 - ], - "translation_norm_m": 0.20978565389024204, - "rotation_rpy_deg_xyz": [ - -0.16494816113173102, - 0.21532140085810142, - 0.29339132928219874 - ], - "rotation_angle_deg": 0.39978913205954264, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.010996073450863508, - 0.019763287751528694, - -0.19362440270682743 - ], - "translation_xyz_cm": [ - 1.0996073450863508, - 1.9763287751528695, - -19.362440270682743 - ], - "translation_norm_m": 0.19494078715769614, - "rotation_rpy_deg_xyz": [ - -0.0012278468090643807, - -0.01296306849368827, - 0.3985178512059501 - ], - "rotation_angle_deg": 0.3987303789420781, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0059720438209368565, - 0.008952841481540963, - -0.13451603496720096 - ], - "translation_xyz_cm": [ - -0.5972043820936856, - 0.8952841481540963, - -13.451603496720097 - ], - "translation_norm_m": 0.1349458496630779, - "rotation_rpy_deg_xyz": [ - 0.32877370901803427, - -0.22772934829786215, - -0.09624424923716766 - ], - "rotation_angle_deg": 0.41120532094290396, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008807822440432655, - 0.01653091532011708, - -0.13421145579441998 - ], - "translation_xyz_cm": [ - 0.8807822440432655, - 1.6530915320117079, - -13.421145579441998 - ], - "translation_norm_m": 0.13551222735945498, - "rotation_rpy_deg_xyz": [ - -0.8179398443254622, - 0.7484997951006033, - 0.29098780790463874 - ], - "rotation_angle_deg": 1.1476273776843582, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.008990733814942364, - -0.0005507941171856157, - -0.06192216134140748 - ], - "translation_xyz_cm": [ - -0.8990733814942364, - -0.055079411718561566, - -6.1922161341407485 - ], - "translation_norm_m": 0.06257388220241711, - "rotation_rpy_deg_xyz": [ - -0.8129592847586236, - 0.3347132730200882, - -0.21330497600845155 - ], - "rotation_angle_deg": 0.904112265977873, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.007602534572638042, - -0.019056911794410443, - 0.06791459139164632 - ], - "translation_xyz_cm": [ - -0.7602534572638042, - -1.9056911794410443, - 6.791459139164632 - ], - "translation_norm_m": 0.07094614959927267, - "rotation_rpy_deg_xyz": [ - 0.2725015762691158, - -0.2866307981781891, - -0.4830658100336522 - ], - "rotation_angle_deg": 0.6237846495328129, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0025212585691049005, - -0.0011749495148111189, - -0.00021474763538229143 - ], - "translation_xyz_cm": [ - 0.25212585691049005, - -0.11749495148111189, - -0.021474763538229143 - ], - "translation_norm_m": 0.0027898687570461194, - "rotation_rpy_deg_xyz": [ - 0.13266041200791756, - -0.19257318409503085, - -0.47789582805506553 - ], - "rotation_angle_deg": 0.5318404107794465, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.005997444487302717, - 0.016738745568542934, - -0.07032153989677957 - ], - "translation_xyz_cm": [ - 0.5997444487302717, - 1.6738745568542934, - -7.032153989677957 - ], - "translation_norm_m": 0.07253463942862785, - "rotation_rpy_deg_xyz": [ - -0.7953655670935981, - -0.22111589568170925, - -0.3093090541707238 - ], - "rotation_angle_deg": 0.8821097957965472, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010666924831950364, - 0.02086016614094599, - -0.06287885550192372 - ], - "translation_xyz_cm": [ - 1.0666924831950364, - 2.086016614094599, - -6.287885550192372 - ], - "translation_norm_m": 0.06710201402365024, - "rotation_rpy_deg_xyz": [ - 0.06836113385751648, - 0.05352754166262119, - 0.006842212300855938 - ], - "rotation_angle_deg": 0.08709087713498583, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013208673449955466, - 0.040997884226590564, - -0.11151082185080909 - ], - "translation_xyz_cm": [ - 1.3208673449955466, - 4.099788422659056, - -11.15108218508091 - ], - "translation_norm_m": 0.1195406163410887, - "rotation_rpy_deg_xyz": [ - -0.9322805897351686, - -0.11275930855999779, - 0.16688400281356514 - ], - "rotation_angle_deg": 0.9536272521242378, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007194824968473568, - 0.017046649838138195, - -0.05370781206172452 - ], - "translation_xyz_cm": [ - 0.7194824968473568, - 1.7046649838138195, - -5.3707812061724525 - ], - "translation_norm_m": 0.0568056586396865, - "rotation_rpy_deg_xyz": [ - -0.9328863417491617, - -0.029397038165186046, - 0.1653108227436858 - ], - "rotation_angle_deg": 0.9478338634395149, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0013687018385954985, - -0.015202239841547893, - -0.1629786925255543 - ], - "translation_xyz_cm": [ - -0.13687018385954985, - -1.5202239841547893, - -16.29786925255543 - ], - "translation_norm_m": 0.16369189246343904, - "rotation_rpy_deg_xyz": [ - -0.5445268100378047, - 1.727880424613969, - -0.33448755800526864 - ], - "rotation_angle_deg": 1.8407709215807582, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.002779534327510269, - 0.012462440083425674, - -0.03653729183270861 - ], - "translation_xyz_cm": [ - -0.2779534327510269, - 1.2462440083425674, - -3.653729183270861 - ], - "translation_norm_m": 0.03870415892871589, - "rotation_rpy_deg_xyz": [ - 0.5265866569685541, - 0.44603803063870856, - 0.20352440093729168 - ], - "rotation_angle_deg": 0.7189084691560212, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.014861928952084602, - 0.02205042912585986, - -0.03040468166714143 - ], - "translation_xyz_cm": [ - 1.4861928952084602, - 2.205042912585986, - -3.0404681667141427 - ], - "translation_norm_m": 0.04039236343780326, - "rotation_rpy_deg_xyz": [ - 0.677356161950493, - 1.014302759733513, - 0.19495464519577474 - ], - "rotation_angle_deg": 1.2342113342267027, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005248483443849317, - 0.00981526784985487, - -0.021744730226941133 - ], - "translation_xyz_cm": [ - -0.5248483443849317, - 0.981526784985487, - -2.174473022694113 - ], - "translation_norm_m": 0.02442783973394296, - "rotation_rpy_deg_xyz": [ - -0.7604368281264984, - 2.3300780835505996, - 0.6324976157674249 - ], - "rotation_angle_deg": 2.535152977471376, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016914069857490555, - 0.015123221870820047, - -0.005030067022912553 - ], - "translation_xyz_cm": [ - 1.6914069857490555, - 1.5123221870820047, - -0.5030067022912553 - ], - "translation_norm_m": 0.023240033845782427, - "rotation_rpy_deg_xyz": [ - 0.3326405676855964, - 0.3452650468787511, - -0.011910629217558389 - ], - "rotation_angle_deg": 0.4796072373323929, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.0003099509493385, - 0.011189392642213525, - 0.011988687963139826 - ], - "translation_xyz_cm": [ - 0.030995094933849998, - 1.1189392642213525, - 1.1988687963139826 - ], - "translation_norm_m": 0.01640204915155883, - "rotation_rpy_deg_xyz": [ - -0.19834464267731342, - 1.8500238169202934, - 0.475602336486353 - ], - "rotation_angle_deg": 1.921236302703376, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015384591123796754, - 0.012563000576964356, - 0.24585614610284806 - ], - "translation_xyz_cm": [ - 1.5384591123796754, - 1.2563000576964356, - 24.585614610284807 - ], - "translation_norm_m": 0.2466571693750015, - "rotation_rpy_deg_xyz": [ - -0.45394399308455174, - -0.013057112588023272, - -0.29592067302531927 - ], - "rotation_angle_deg": 0.5420653421542649, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.006407936672089054, - -0.005342845965579879, - 0.025472298905941798 - ], - "translation_xyz_cm": [ - 0.6407936672089054, - -0.5342845965579879, - 2.54722989059418 - ], - "translation_norm_m": 0.026803836795486213, - "rotation_rpy_deg_xyz": [ - 0.14182490971029096, - 1.5946309746760485, - 0.5179462400897543 - ], - "rotation_angle_deg": 1.6820128905486542, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03609367995265489, - -0.004077517849049972, - 0.2331625644333101 - ], - "translation_xyz_cm": [ - 3.609367995265489, - -0.4077517849049972, - 23.31625644333101 - ], - "translation_norm_m": 0.23597491675483537, - "rotation_rpy_deg_xyz": [ - -0.019521811989637643, - -0.19384658238974423, - -0.251186118397094 - ], - "rotation_angle_deg": 0.3179128713214332, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0339914453206025, - 0.011374721347911176, - 0.33994447149983836 - ], - "translation_xyz_cm": [ - 3.39914453206025, - 1.1374721347911176, - 33.994447149983834 - ], - "translation_norm_m": 0.3418289723590301, - "rotation_rpy_deg_xyz": [ - -0.5339395209301538, - 0.5340359313816545, - -0.23597177742653314 - ], - "rotation_angle_deg": 0.7904373733336556, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009274030974021574, - 0.01280857968224991, - 0.15578392687699197 - ], - "translation_xyz_cm": [ - 0.9274030974021574, - 1.280857968224991, - 15.578392687699196 - ], - "translation_norm_m": 0.15658447955400828, - "rotation_rpy_deg_xyz": [ - 0.905007991556393, - -1.3494472175203678, - -0.7396176438432185 - ], - "rotation_angle_deg": 1.7807981451128492, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009235015734691654, - 0.025887880001989494, - 0.21707325975069583 - ], - "translation_xyz_cm": [ - -0.9235015734691654, - 2.5887880001989494, - 21.707325975069583 - ], - "translation_norm_m": 0.21880646230267164, - "rotation_rpy_deg_xyz": [ - 0.7156909985785658, - -0.2480942889029289, - -0.693241401730359 - ], - "rotation_angle_deg": 1.0257640454697428, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003941061141203406, - -0.011944687924971387, - 0.10784244244349966 - ], - "translation_xyz_cm": [ - 0.3941061141203406, - -1.1944687924971387, - 10.784244244349967 - ], - "translation_norm_m": 0.10857347707761411, - "rotation_rpy_deg_xyz": [ - -0.6963664558240159, - 0.7141099226446723, - 0.0053134694540879586 - ], - "rotation_angle_deg": 0.9974704476636949, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002150227988608977, - -0.0033887297596324473, - -0.05038280509424025 - ], - "translation_xyz_cm": [ - 0.2150227988608977, - -0.3388729759632447, - -5.038280509424025 - ], - "translation_norm_m": 0.05054239823109918, - "rotation_rpy_deg_xyz": [ - -0.5094356779280086, - 0.7437720580333383, - 0.09102165129079781 - ], - "rotation_angle_deg": 0.9064240989881033, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0009846231724117693, - 0.027285182445507594, - 0.04177740441054856 - ], - "translation_xyz_cm": [ - 0.09846231724117693, - 2.7285182445507594, - 4.177740441054856 - ], - "translation_norm_m": 0.0499079370757679, - "rotation_rpy_deg_xyz": [ - -0.818242116560719, - 0.016227478079622576, - -0.7396158616753039 - ], - "rotation_angle_deg": 1.1030115174582322, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015954050616062698, - -0.03983414479500058, - -0.026212325547745104 - ], - "translation_xyz_cm": [ - 1.5954050616062698, - -3.983414479500058, - -2.6212325547745103 - ], - "translation_norm_m": 0.050282967625528356, - "rotation_rpy_deg_xyz": [ - 0.10423182220160881, - 0.21740706144047997, - -0.643655303003996 - ], - "rotation_angle_deg": 0.6875145062858429, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.004514582622816121, - 0.013955130204843735, - -0.007489171956879724 - ], - "translation_xyz_cm": [ - 0.4514582622816121, - 1.3955130204843735, - -0.7489171956879724 - ], - "translation_norm_m": 0.01646860078731915, - "rotation_rpy_deg_xyz": [ - -0.10133491312826456, - 0.26456200768337507, - 0.1448657742091669 - ], - "rotation_angle_deg": 0.3183011725701562, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.008343840747982334, - -0.012098566759296325, - -0.020505308164598418 - ], - "translation_xyz_cm": [ - 0.8343840747982334, - -1.2098566759296325, - -2.0505308164598417 - ], - "translation_norm_m": 0.025228211569233102, - "rotation_rpy_deg_xyz": [ - -1.348363055209726, - -0.9167228122015666, - 0.15063076472013687 - ], - "rotation_angle_deg": 1.6364178282622448, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0076637958147025564, - 0.00492740969514413, - 0.05265533041635858 - ], - "translation_xyz_cm": [ - 0.7663795814702556, - 0.49274096951441304, - 5.265533041635858 - ], - "translation_norm_m": 0.05343778582472472, - "rotation_rpy_deg_xyz": [ - -0.4112069376050002, - -0.17374019652525935, - -0.13789233850405208 - ], - "rotation_angle_deg": 0.46740005692383657, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.009600880370153497, - -0.024258806533743793, - 0.014661676588050829 - ], - "translation_xyz_cm": [ - -0.9600880370153497, - -2.4258806533743793, - 1.466167658805083 - ], - "translation_norm_m": 0.029927100739901402, - "rotation_rpy_deg_xyz": [ - 0.6824451978797951, - -0.08824484625371838, - -0.21275985988317453 - ], - "rotation_angle_deg": 0.7201118634070781, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010121112486917383, - 0.021694605032705372, - 0.03593642001612414 - ], - "translation_xyz_cm": [ - -1.0121112486917383, - 2.169460503270537, - 3.593642001612414 - ], - "translation_norm_m": 0.04318007745561844, - "rotation_rpy_deg_xyz": [ - 0.10729396651947076, - 1.2420153423879607, - -0.28000389083202315 - ], - "rotation_angle_deg": 1.2779530448915686, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021431186214568854, - -0.027613027287897385, - -0.06904512519429185 - ], - "translation_xyz_cm": [ - 0.21431186214568854, - -2.7613027287897385, - -6.9045125194291845 - ], - "translation_norm_m": 0.0743928863973111, - "rotation_rpy_deg_xyz": [ - 0.38687187420754865, - 0.45744081727673186, - -0.08447254204740909 - ], - "rotation_angle_deg": 0.6052417791756737, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0153902300315778, - 0.014123018714938596, - -0.14020546626296165 - ], - "translation_xyz_cm": [ - 1.53902300315778, - 1.4123018714938596, - -14.020546626296165 - ], - "translation_norm_m": 0.14175292451325958, - "rotation_rpy_deg_xyz": [ - -0.22727405470276052, - 0.8041624203835127, - -0.03597322727163254 - ], - "rotation_angle_deg": 0.8363666343830843, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0015771386273704113, - 0.027605195205092414, - -0.1361695940594602 - ], - "translation_xyz_cm": [ - 0.15771386273704113, - 2.7605195205092414, - -13.61695940594602 - ], - "translation_norm_m": 0.13894852469486454, - "rotation_rpy_deg_xyz": [ - -0.3872088650153083, - 1.0688677147228443, - 0.20851825797651846 - ], - "rotation_angle_deg": 1.1564554526171857, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018039551125814013, - 0.02020098018117611, - -0.0485903889397746 - ], - "translation_xyz_cm": [ - -1.8039551125814013, - 2.020098018117611, - -4.85903889397746 - ], - "translation_norm_m": 0.05562850800102136, - "rotation_rpy_deg_xyz": [ - -0.05390869285858829, - 0.1976489171521654, - 0.07355930791969285 - ], - "rotation_angle_deg": 0.2177059580935924, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.031210753515040324, - 0.025574717242113354, - -0.07512339665010188 - ], - "translation_xyz_cm": [ - -3.1210753515040324, - 2.5574717242113354, - -7.512339665010188 - ], - "translation_norm_m": 0.08527427526070915, - "rotation_rpy_deg_xyz": [ - 0.10798255021463024, - 0.8193236744650109, - 0.3197722520822767 - ], - "rotation_angle_deg": 0.885838621632559, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00831045121578311, - 0.013843546864520606, - -0.036820522286788414 - ], - "translation_xyz_cm": [ - -0.831045121578311, - 1.3843546864520606, - -3.6820522286788413 - ], - "translation_norm_m": 0.04020520178623621, - "rotation_rpy_deg_xyz": [ - 0.39974613309119217, - 0.7340386883927469, - 0.24958045435644907 - ], - "rotation_angle_deg": 0.8715610720954865, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.00894739298445102, - 0.0040912593494293326, - 0.0506196002321747 - ], - "translation_xyz_cm": [ - 0.8947392984451019, - 0.40912593494293326, - 5.06196002321747 - ], - "translation_norm_m": 0.05156683209144883, - "rotation_rpy_deg_xyz": [ - 1.1186499455221801, - -0.049201371137048366, - -0.2781843838826371 - ], - "rotation_angle_deg": 1.153653006460214, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01044869066002807, - 0.014058936571188063, - 0.005674979032376112 - ], - "translation_xyz_cm": [ - -1.044869066002807, - 1.4058936571188063, - 0.5674979032376113 - ], - "translation_norm_m": 0.01841288193193981, - "rotation_rpy_deg_xyz": [ - 1.0176850945359526, - 0.32888439595989233, - 0.3996664359711866 - ], - "rotation_angle_deg": 1.1407186210171152, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.021867404177806637, - 0.020952410523287668, - 0.09393092256019778 - ], - "translation_xyz_cm": [ - 2.1867404177806637, - 2.095241052328767, - 9.393092256019777 - ], - "translation_norm_m": 0.09869247734869058, - "rotation_rpy_deg_xyz": [ - 1.8080287437576597, - -0.26466777382907114, - -0.5008982210789754 - ], - "rotation_angle_deg": 1.893595912556167, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0060206651579473025, - 0.014634862258029013, - 0.01845068831567713 - ], - "translation_xyz_cm": [ - 0.6020665157947303, - 1.4634862258029013, - 1.845068831567713 - ], - "translation_norm_m": 0.024307519445181305, - "rotation_rpy_deg_xyz": [ - 1.4827099675215467, - 0.46655898952885394, - 0.19779643577048017 - ], - "rotation_angle_deg": 1.566150340011081, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008863920037717854, - 0.015030399668509498, - 0.001742505544354192 - ], - "translation_xyz_cm": [ - 0.8863920037717854, - 1.5030399668509498, - 0.1742505544354192 - ], - "translation_norm_m": 0.017536200221321938, - "rotation_rpy_deg_xyz": [ - 0.540071810677193, - 0.986594995524653, - -0.5025310524035612 - ], - "rotation_angle_deg": 1.2337920260254294, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.0004646642872501161, - -0.01553377554852936, - 0.006622977698366499 - ], - "translation_xyz_cm": [ - 0.04646642872501161, - -1.553377554852936, - 0.6622977698366499 - ], - "translation_norm_m": 0.016893132607216293, - "rotation_rpy_deg_xyz": [ - -0.7211452050657524, - -0.188763125206156, - -0.6987667557986833 - ], - "rotation_angle_deg": 1.0225505872679699, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006540851697354633, - 0.040326124921785, - 0.07306370646565859 - ], - "translation_xyz_cm": [ - -0.6540851697354633, - 4.0326124921785, - 7.306370646565859 - ], - "translation_norm_m": 0.08370952332103031, - "rotation_rpy_deg_xyz": [ - -1.302814168669691, - -0.600844507133393, - 0.6105050434568302 - ], - "rotation_angle_deg": 1.556495869523796, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02010133223356725, - 0.025008773241824933, - 0.06014134756967511 - ], - "translation_xyz_cm": [ - 2.010133223356725, - 2.5008773241824933, - 6.014134756967511 - ], - "translation_norm_m": 0.06816512293043807, - "rotation_rpy_deg_xyz": [ - -0.5547609780192527, - -0.3373912978754272, - 0.48915497518335266 - ], - "rotation_angle_deg": 0.8119506258047068, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.010417485785278568, - -0.02480826999391339, - 0.026370682751289364 - ], - "translation_xyz_cm": [ - -1.0417485785278568, - -2.480826999391339, - 2.6370682751289363 - ], - "translation_norm_m": 0.03767475519424824, - "rotation_rpy_deg_xyz": [ - 0.7101465849109376, - -0.7876590345782726, - -0.13092660579824122 - ], - "rotation_angle_deg": 1.0679747621512234, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0055032593079631376, - 0.0002656943957939917, - 0.03494916948632164 - ], - "translation_xyz_cm": [ - -0.5503259307963138, - 0.026569439579399168, - 3.494916948632164 - ], - "translation_norm_m": 0.03538079852556009, - "rotation_rpy_deg_xyz": [ - 0.4127115364150137, - -1.348332990694566, - 0.23240685138234501 - ], - "rotation_angle_deg": 1.4298923818924867, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016884160143425753, - 0.008607552821607689, - 0.03879581418736493 - ], - "translation_xyz_cm": [ - -1.6884160143425753, - 0.8607552821607689, - 3.8795814187364925 - ], - "translation_norm_m": 0.04317730917723057, - "rotation_rpy_deg_xyz": [ - -0.9118064284041235, - -1.3797937097033854, - 0.17136247559601578 - ], - "rotation_angle_deg": 1.6615600301528897, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.005775508477052105, - 0.02076714939687674, - -0.05076414348547613 - ], - "translation_xyz_cm": [ - 0.5775508477052105, - 2.076714939687674, - -5.076414348547613 - ], - "translation_norm_m": 0.05515096786145015, - "rotation_rpy_deg_xyz": [ - -0.5050673809886981, - -0.66026085625198, - 0.08321837418381936 - ], - "rotation_angle_deg": 0.8351499617353654, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006883474554614022, - 0.003970201090887748, - -0.0163538720701132 - ], - "translation_xyz_cm": [ - -0.6883474554614022, - 0.39702010908877483, - -1.6353872070113198 - ], - "translation_norm_m": 0.018182239970139364, - "rotation_rpy_deg_xyz": [ - -0.034951376794299036, - -0.32397088612378405, - -0.05340719174115674 - ], - "rotation_angle_deg": 0.3302144844170468, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008893183134704774, - 0.02383393553519708, - -0.028835517137602337 - ], - "translation_xyz_cm": [ - 0.8893183134704774, - 2.383393553519708, - -2.883551713760234 - ], - "translation_norm_m": 0.03845298737362659, - "rotation_rpy_deg_xyz": [ - 0.7856163908613215, - 0.09621887346271842, - -0.15207965200918738 - ], - "rotation_angle_deg": 0.8060890358556931, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014084056489773733, - 0.012460405173852052, - -0.030561680599959947 - ], - "translation_xyz_cm": [ - 1.4084056489773733, - 1.2460405173852052, - -3.056168059995995 - ], - "translation_norm_m": 0.03588368243920438, - "rotation_rpy_deg_xyz": [ - 0.888256895521576, - 0.15226773325369988, - -0.08351433121265298 - ], - "rotation_angle_deg": 0.9051833819505575, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0027345237894904617, - 0.0020992149751937195, - 0.023853082836052163 - ], - "translation_xyz_cm": [ - 0.27345237894904617, - 0.20992149751937195, - 2.3853082836052164 - ], - "translation_norm_m": 0.024100910452738773, - "rotation_rpy_deg_xyz": [ - 1.1521027638005261, - -0.21735787213369703, - 0.017773028427946282 - ], - "rotation_angle_deg": 1.1725942093884534, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.07402348553420701, - "improved_pairs": 24, - "worsened_pairs": 42, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08265109992793152, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152192452926, - 0.0011901746480735614, - 0.7182307404781154 - ], - "rotation_rpy_deg_xyz": [ - -0.886624718165571, - 1.3011901167388817, - -0.8376398312653468 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10139401948155134, - "median": 0.054850576572023885, - "p90": 0.15948853159195353, - "p95": 0.21583565899176332, - "max": 0.33671277728950366 - }, - "rotation_deg": { - "rms": 1.0344448200154543, - "median": 0.843773712877115, - "p90": 1.626756213173929, - "p95": 1.8084108535270682, - "max": 2.413812387144199 - }, - "normalized_pair_score": { - "rms": 2.896999001946205, - "median": 2.42538893085153, - "p90": 4.590039157812415, - "p95": 4.8416981828342465, - "max": 6.852549388907909 - }, - "normalized_global_rms": 2.896999001946205 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012273502667841718, - 0.013750075200805512, - 0.07582077909708475 - ], - "translation_xyz_cm": [ - -1.2273502667841718, - 1.3750075200805512, - 7.582077909708475 - ], - "translation_norm_m": 0.07802880223772661, - "rotation_rpy_deg_xyz": [ - -0.515722917776988, - -0.0835459171102501, - 0.025240782383964606 - ], - "rotation_angle_deg": 0.5230373912267472, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6807154082401394, - "median": 0.7133278004221145, - "p90": 2.3175185373442213, - "p95": 3.9104710727627636, - "max": 5.650741373677544 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012273502667841718, - 0.013750075200805512, - 0.07582077909708475 - ], - "translation_xyz_cm": [ - -1.2273502667841718, - 1.3750075200805512, - 7.582077909708475 - ], - "translation_norm_m": 0.07802880223772661, - "rotation_rpy_deg_xyz": [ - -0.515722917776988, - -0.0835459171102501, - 0.025240782383964606 - ], - "rotation_angle_deg": 0.5230373912267472, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02119631155142665, - -0.014978593526507211, - 0.12994451134180063 - ], - "translation_xyz_cm": [ - 2.119631155142665, - -1.4978593526507211, - 12.994451134180062 - ], - "translation_norm_m": 0.13251119920699841, - "rotation_rpy_deg_xyz": [ - -0.2859995191891049, - -0.1560693864068539, - -0.34522485397194785 - ], - "rotation_angle_deg": 0.47497594758710626, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03396818235809751, - 0.00878382019677093, - 0.10607248389310456 - ], - "translation_xyz_cm": [ - 3.396818235809751, - 0.8783820196770931, - 10.607248389310456 - ], - "translation_norm_m": 0.11172450379936845, - "rotation_rpy_deg_xyz": [ - -0.23851028397301854, - -0.20208116029095863, - -0.40071059519729996 - ], - "rotation_angle_deg": 0.508556349911955, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0346510444157363, - -0.01858136528990001, - 0.04667892716842384 - ], - "translation_xyz_cm": [ - 3.46510444157363, - -1.858136528990001, - 4.667892716842384 - ], - "translation_norm_m": 0.06103182986551401, - "rotation_rpy_deg_xyz": [ - 0.2727109329174662, - 0.10412671169097691, - -0.3505805509176563 - ], - "rotation_angle_deg": 0.45639217061688064, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.046599157030482785, - 0.01201418458500203, - 0.02414320862511324 - ], - "translation_xyz_cm": [ - 4.659915703048279, - 1.201418458500203, - 2.4143208625113237 - ], - "translation_norm_m": 0.05383973058912754, - "rotation_rpy_deg_xyz": [ - 0.39468716432557627, - 0.30706777359276505, - -0.38257391851367745 - ], - "rotation_angle_deg": 0.6302692451060993, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.013824474119147945, - 0.01031619622659119, - -0.032051111948500015 - ], - "translation_xyz_cm": [ - 1.3824474119147945, - 1.031619622659119, - -3.2051111948500015 - ], - "translation_norm_m": 0.03639799124116338, - "rotation_rpy_deg_xyz": [ - 0.52952798576425, - 0.22244546984974073, - 0.13308616079385432 - ], - "rotation_angle_deg": 0.5893383546314099, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00557795419258289, - 0.021039649660189813, - -0.009979750464636731 - ], - "translation_xyz_cm": [ - 0.557795419258289, - 2.103964966018981, - -0.9979750464636731 - ], - "translation_norm_m": 0.02394526780252197, - "rotation_rpy_deg_xyz": [ - 0.27521971511658333, - 0.23577462209218872, - -0.033499231338283295 - ], - "rotation_angle_deg": 0.36399943837705984, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03238153180945386, - 0.0008425068358075549, - -0.07100889648022081 - ], - "translation_xyz_cm": [ - -3.2381531809453863, - 0.08425068358075549, - -7.100889648022081 - ], - "translation_norm_m": 0.07804829786378284, - "rotation_rpy_deg_xyz": [ - 0.5632000694209124, - 0.5518017340856848, - 0.534349401120655 - ], - "rotation_angle_deg": 0.9509487171329924, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03030885735916261, - -0.016188611436472655, - -0.12875517808071896 - ], - "translation_xyz_cm": [ - -3.030885735916261, - -1.6188611436472655, - -12.875517808071896 - ], - "translation_norm_m": 0.1332613742134487, - "rotation_rpy_deg_xyz": [ - 0.6366570525064057, - 0.36631748801878294, - 0.3986130349138202 - ], - "rotation_angle_deg": 0.8347376664569337, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03116488362423206, - -0.019801674550828874, - -0.050759817210635216 - ], - "translation_xyz_cm": [ - -3.116488362423206, - -1.9801674550828874, - -5.075981721063521 - ], - "translation_norm_m": 0.06276874484634826, - "rotation_rpy_deg_xyz": [ - 0.4815637922603291, - 0.38094344540770475, - 0.5860479423359293 - ], - "rotation_angle_deg": 0.8476987946919522, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.037904535831685994, - -0.037186128928924866, - -0.07671119042341559 - ], - "translation_xyz_cm": [ - -3.7904535831685995, - -3.7186128928924864, - -7.67111904234156 - ], - "translation_norm_m": 0.09329613474046884, - "rotation_rpy_deg_xyz": [ - 0.6268512424268373, - 0.8211744743409899, - 0.5013861484957061 - ], - "rotation_angle_deg": 1.1463594545058189, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01303056623486741, - -0.010167335537615035, - -0.03059533425779505 - ], - "translation_xyz_cm": [ - -1.3030566234867411, - -1.0167335537615037, - -3.059533425779505 - ], - "translation_norm_m": 0.03477419800199458, - "rotation_rpy_deg_xyz": [ - 0.3305955185099562, - 0.29537346473146064, - -0.08720375254234271 - ], - "rotation_angle_deg": 0.45198641159390757, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.01206554664238646, - -0.0008686049230853116, - -0.21000224699512413 - ], - "translation_xyz_cm": [ - 1.206554664238646, - -0.08686049230853116, - -21.00022469951241 - ], - "translation_norm_m": 0.21035036399610324, - "rotation_rpy_deg_xyz": [ - -0.08912484866930692, - 0.11972977324021028, - 0.2937619464853215 - ], - "rotation_angle_deg": 0.3295894380298957, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.01027816511100832, - 0.018996224310154113, - -0.19452017096562557 - ], - "translation_xyz_cm": [ - 1.027816511100832, - 1.8996224310154113, - -19.452017096562557 - ], - "translation_norm_m": 0.19571559500608796, - "rotation_rpy_deg_xyz": [ - 0.04528928558677578, - -0.09601551349723272, - 0.3981842369577614 - ], - "rotation_angle_deg": 0.41212978442594933, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.007000067613249894, - 0.0077375847232997175, - -0.1335163016099367 - ], - "translation_xyz_cm": [ - -0.7000067613249894, - 0.7737584723299717, - -13.351630160993668 - ], - "translation_norm_m": 0.13392338839626144, - "rotation_rpy_deg_xyz": [ - 0.4226597306520049, - -0.3261035057081208, - -0.0963660170239345 - ], - "rotation_angle_deg": 0.5422534332915807, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008388908460665423, - 0.0161987181174873, - -0.13375575822561867 - ], - "translation_xyz_cm": [ - 0.8388908460665423, - 1.6198718117487299, - -13.375575822561867 - ], - "translation_norm_m": 0.13499398176334154, - "rotation_rpy_deg_xyz": [ - -0.8084908549093847, - 0.7075060940116674, - 0.29111398364103325 - ], - "rotation_angle_deg": 1.1143900724128104, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009932156107248624, - -0.0011340294207695667, - -0.0599263794755359 - ], - "translation_xyz_cm": [ - -0.9932156107248624, - -0.11340294207695667, - -5.99263794755359 - ], - "translation_norm_m": 0.060754462426326, - "rotation_rpy_deg_xyz": [ - -0.7718187379882078, - 0.2553193777163115, - -0.2125709861655731 - ], - "rotation_angle_deg": 0.8398486310622777, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.00829133047910946, - -0.019130987737095304, - 0.06884189912433236 - ], - "translation_xyz_cm": [ - -0.829133047910946, - -1.9130987737095304, - 6.884189912433236 - ], - "translation_norm_m": 0.07193016007180474, - "rotation_rpy_deg_xyz": [ - 0.28560255020438885, - -0.3346633064947069, - -0.48378772688554544 - ], - "rotation_angle_deg": 0.6533073354099473, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0016489886371057194, - -0.0015255588491572825, - 0.00094380441010747 - ], - "translation_xyz_cm": [ - 0.16489886371057194, - -0.15255588491572825, - 0.094380441010747 - ], - "translation_norm_m": 0.002436649357639334, - "rotation_rpy_deg_xyz": [ - 0.15950646360005527, - -0.2593050590139673, - -0.4785475246748707 - ], - "rotation_angle_deg": 0.5668713447808463, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.004984769565777314, - 0.01607935844340691, - -0.06902337973241698 - ], - "translation_xyz_cm": [ - 0.4984769565777314, - 1.607935844340691, - -6.902337973241698 - ], - "translation_norm_m": 0.07104660896384073, - "rotation_rpy_deg_xyz": [ - -0.7467533839302408, - -0.3054575166552506, - -0.3084491270636921 - ], - "rotation_angle_deg": 0.8644714311656655, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010392144236766265, - 0.02069494956350304, - -0.062170518719551204 - ], - "translation_xyz_cm": [ - 1.0392144236766265, - 2.069494956350304, - -6.21705187195512 - ], - "translation_norm_m": 0.06634343220795677, - "rotation_rpy_deg_xyz": [ - 0.07139009081988294, - 0.030521331812318482, - 0.006506800533151232 - ], - "rotation_angle_deg": 0.07791140891886357, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012669544013501066, - 0.04063694607042234, - -0.1100250500824161 - ], - "translation_xyz_cm": [ - 1.2669544013501066, - 4.063694607042234, - -11.00250500824161 - ], - "translation_norm_m": 0.11797198979875954, - "rotation_rpy_deg_xyz": [ - -0.9186666974032417, - -0.1616942211636445, - 0.16718354119765155 - ], - "rotation_angle_deg": 0.9474224225111134, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006854316879474964, - 0.01689591723777073, - -0.052693813537176934 - ], - "translation_xyz_cm": [ - 0.6854316879474964, - 1.689591723777073, - -5.2693813537176935 - ], - "translation_norm_m": 0.05575922940895636, - "rotation_rpy_deg_xyz": [ - -0.9285606542260966, - -0.05706580009457916, - 0.1654061692680799 - ], - "rotation_angle_deg": 0.9448211203286838, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.001942183405093223, - -0.015688432656623785, - -0.16144844939633649 - ], - "translation_xyz_cm": [ - -0.1942183405093223, - -1.5688432656623785, - -16.14484493963365 - ], - "translation_norm_m": 0.16222053140118195, - "rotation_rpy_deg_xyz": [ - -0.5236013260804179, - 1.6681091033923154, - -0.33443249442340506 - ], - "rotation_angle_deg": 1.7786132933555778, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0032137368271078492, - 0.012301755243862011, - -0.035217088006144204 - ], - "translation_xyz_cm": [ - -0.3213736827107849, - 1.2301755243862011, - -3.5217088006144204 - ], - "translation_norm_m": 0.03744201615974094, - "rotation_rpy_deg_xyz": [ - 0.5332361353208555, - 0.4116062675663906, - 0.20279399671913212 - ], - "rotation_angle_deg": 0.7029277058827201, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.014072592502860193, - 0.021664908706218622, - -0.029643739804075142 - ], - "translation_xyz_cm": [ - 1.4072592502860193, - 2.166490870621862, - -2.9643739804075144 - ], - "translation_norm_m": 0.03932120850853968, - "rotation_rpy_deg_xyz": [ - 0.702990556549933, - 0.9488765942363516, - 0.1936789682269791 - ], - "rotation_angle_deg": 1.195745196949885, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.006311730968653784, - 0.00794484301864884, - -0.01933931216056749 - ], - "translation_xyz_cm": [ - -0.6311730968653784, - 0.794484301864884, - -1.933931216056749 - ], - "translation_norm_m": 0.021839585006485588, - "rotation_rpy_deg_xyz": [ - -0.614168133162664, - 2.242840327874244, - 0.6354381677066584 - ], - "rotation_angle_deg": 2.413812387144199, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01646129771222915, - 0.015016250391435726, - -0.004560313522245951 - ], - "translation_xyz_cm": [ - 1.646129771222915, - 1.5016250391435726, - -0.4560313522245951 - ], - "translation_norm_m": 0.022743318966459435, - "rotation_rpy_deg_xyz": [ - 0.339767966636154, - 0.30961689651545576, - -0.012540778015805713 - ], - "rotation_angle_deg": 0.4598748836354997, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0009616722788510224, - 0.009721971661267315, - 0.014467816743086063 - ], - "translation_xyz_cm": [ - -0.09616722788510224, - 0.9721971661267315, - 1.4467816743086064 - ], - "translation_norm_m": 0.01745735569511937, - "rotation_rpy_deg_xyz": [ - -0.0856155482551795, - 1.752275345633886, - 0.47680561203867805 - ], - "rotation_angle_deg": 1.8183433735842316, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.014189689551271867, - 0.010209200090250281, - 0.24423097892289114 - ], - "translation_xyz_cm": [ - 1.4189689551271867, - 1.020920009025028, - 24.423097892289114 - ], - "translation_norm_m": 0.24485576595554767, - "rotation_rpy_deg_xyz": [ - -0.2871040495327816, - -0.08595648560835722, - -0.2928532665508535 - ], - "rotation_angle_deg": 0.4191732520716472, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.005139896304903413, - -0.006332679151890397, - 0.027609980209592898 - ], - "translation_xyz_cm": [ - 0.5139896304903413, - -0.6332679151890397, - 2.7609980209592897 - ], - "translation_norm_m": 0.028789448873503265, - "rotation_rpy_deg_xyz": [ - 0.21821741815588913, - 1.4988974796153036, - 0.5178147892265356 - ], - "rotation_angle_deg": 1.5998344477995556, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03458806433364725, - -0.0059023003124833995, - 0.23137778725354227 - ], - "translation_xyz_cm": [ - 3.458806433364725, - -0.59023003124834, - 23.137778725354227 - ], - "translation_norm_m": 0.23402318641039124, - "rotation_rpy_deg_xyz": [ - 0.11632479527065477, - -0.28575635982081465, - -0.24968190503423518 - ], - "rotation_angle_deg": 0.39671674463448364, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03279673812115913, - 0.008812436478509156, - 0.3349958347829645 - ], - "translation_xyz_cm": [ - 3.279673812115913, - 0.8812436478509156, - 33.49958347829645 - ], - "translation_norm_m": 0.33671277728950366, - "rotation_rpy_deg_xyz": [ - -0.3614265650977547, - 0.466635200725326, - -0.23263111970319197 - ], - "rotation_angle_deg": 0.6338839348448986, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.008361032194418971, - 0.012845871058369207, - 0.1560054069381704 - ], - "translation_xyz_cm": [ - 0.8361032194418971, - 1.2845871058369207, - 15.600540693817038 - ], - "translation_norm_m": 0.15675653178272508, - "rotation_rpy_deg_xyz": [ - 0.923626572942482, - -1.4060543448911147, - -0.7410252738426366 - ], - "rotation_angle_deg": 1.8336616223024063, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010728392234058415, - 0.02553457429016559, - 0.21589475092605578 - ], - "translation_xyz_cm": [ - -1.0728392234058415, - 2.553457429016559, - 21.58947509260558 - ], - "translation_norm_m": 0.21766409065698333, - "rotation_rpy_deg_xyz": [ - 0.7671547642076333, - -0.33406861259515797, - -0.6945914859146701 - ], - "rotation_angle_deg": 1.0860333666628483, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003320593600634636, - -0.011921062126160509, - 0.10836897531956416 - ], - "translation_xyz_cm": [ - 0.3320593600634636, - -1.1921062126160509, - 10.836897531956415 - ], - "translation_norm_m": 0.10907324546326043, - "rotation_rpy_deg_xyz": [ - -0.6860262699701816, - 0.6712627432156184, - 0.005364651759482591 - ], - "rotation_angle_deg": 0.9598396879049608, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0012719835922228029, - -0.0038184019393399105, - -0.04762711490967106 - ], - "translation_xyz_cm": [ - 0.1271983592222803, - -0.38184019393399105, - -4.7627114909671056 - ], - "translation_norm_m": 0.047796864021065755, - "rotation_rpy_deg_xyz": [ - -0.4791155358175677, - 0.6734897035570675, - 0.09116731388147337 - ], - "rotation_angle_deg": 0.8318426576039071, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.00028499373283796814, - 0.027075257313049272, - 0.04138213809453958 - ], - "translation_xyz_cm": [ - 0.028499373283796814, - 2.7075257313049272, - 4.1382138094539584 - ], - "translation_norm_m": 0.049453332883346995, - "rotation_rpy_deg_xyz": [ - -0.8002908277798098, - -0.03949810788863584, - -0.7393322193153724 - ], - "rotation_angle_deg": 1.0904295457926423, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014911928504075966, - -0.04040630111482679, - -0.021235096341533023 - ], - "translation_xyz_cm": [ - 1.4911928504075966, - -4.040630111482679, - -2.123509634153302 - ], - "translation_norm_m": 0.048020454997083434, - "rotation_rpy_deg_xyz": [ - 0.14226381664395268, - 0.14036504556726948, - -0.6442170632022658 - ], - "rotation_angle_deg": 0.6746710734008035, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.003519966278928255, - 0.013555510908779489, - -0.0020173727457365592 - ], - "translation_xyz_cm": [ - 0.3519966278928255, - 1.355551090877949, - -0.20173727457365592 - ], - "translation_norm_m": 0.01414962301257784, - "rotation_rpy_deg_xyz": [ - -0.07268392684874188, - 0.1959372465670599, - 0.1444985959581438 - ], - "rotation_angle_deg": 0.2541458054876874, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.007560103514932415, - -0.012267879078138977, - -0.01743280672626174 - ], - "translation_xyz_cm": [ - 0.7560103514932415, - -1.2267879078138977, - -1.743280672626174 - ], - "translation_norm_m": 0.02261766505604701, - "rotation_rpy_deg_xyz": [ - -1.3324594061867159, - -0.969406112328205, - 0.1513634581226307 - ], - "rotation_angle_deg": 1.6536779785483025, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.006274040721488072, - 0.00398805620607727, - 0.054993194901440064 - ], - "translation_xyz_cm": [ - 0.6274040721488072, - 0.398805620607727, - 5.499319490144006 - ], - "translation_norm_m": 0.05549342001305646, - "rotation_rpy_deg_xyz": [ - -0.3353379264586897, - -0.26934174279036444, - -0.13710989566871135 - ], - "rotation_angle_deg": 0.45167628467944815, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.009957281734663592, - -0.026867227191390952, - 0.016674434544485764 - ], - "translation_xyz_cm": [ - -0.9957281734663592, - -2.6867227191390954, - 1.6674434544485763 - ], - "translation_norm_m": 0.03315165341088771, - "rotation_rpy_deg_xyz": [ - 0.8796047447628413, - -0.1102874751875873, - -0.20894294784457407 - ], - "rotation_angle_deg": 0.9105877835712745, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.011062810520623634, - 0.02138963985908715, - 0.03828193477951412 - ], - "translation_xyz_cm": [ - -1.1062810520623634, - 2.138963985908715, - 3.8281934779514115 - ], - "translation_norm_m": 0.045226198164113274, - "rotation_rpy_deg_xyz": [ - 0.13546007758816025, - 1.1738775899501497, - -0.2806225764297054 - ], - "rotation_angle_deg": 1.2148507894592246, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008613487472253212, - -0.02902210596729271, - -0.06333958372220654 - ], - "translation_xyz_cm": [ - 0.08613487472253212, - -2.902210596729271, - -6.333958372220653 - ], - "translation_norm_m": 0.06967730923725116, - "rotation_rpy_deg_xyz": [ - 0.48903453000759556, - 0.35890162149795, - -0.08451716738429373 - ], - "rotation_angle_deg": 0.6126714873540658, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.014902290087260184, - 0.011723553611015625, - -0.13178617407458793 - ], - "translation_xyz_cm": [ - 1.4902290087260184, - 1.1723553611015625, - -13.178617407458793 - ], - "translation_norm_m": 0.13314321475889337, - "rotation_rpy_deg_xyz": [ - -0.03453231035106172, - 0.7681842131082298, - -0.032104153198043814 - ], - "rotation_angle_deg": 0.7696201954564982, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0017392483645304324, - 0.025194004890561672, - -0.1293412463834099 - ], - "translation_xyz_cm": [ - 0.17392483645304324, - 2.519400489056167, - -12.934124638340991 - ], - "translation_norm_m": 0.13178361386497608, - "rotation_rpy_deg_xyz": [ - -0.1884643967610035, - 1.0862394928612569, - 0.21322582239515325 - ], - "rotation_angle_deg": 1.1232362636438045, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019140372854559606, - 0.019356740725566146, - -0.046509280918771025 - ], - "translation_xyz_cm": [ - -1.9140372854559606, - 1.9356740725566146, - -4.650928091877103 - ], - "translation_norm_m": 0.05389017068176266, - "rotation_rpy_deg_xyz": [ - 0.007998251057806688, - 0.1066305149103925, - 0.07351328630616319 - ], - "rotation_angle_deg": 0.12975802922554627, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03232521419054146, - 0.024116034344768278, - -0.07391446099707295 - ], - "translation_xyz_cm": [ - -3.2325214190541463, - 2.411603434476828, - -7.391446099707295 - ], - "translation_norm_m": 0.08420124779045882, - "rotation_rpy_deg_xyz": [ - 0.22318467717621293, - 0.721922258399074, - 0.32051382944258944 - ], - "rotation_angle_deg": 0.8202492269463538, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008953804777239949, - 0.01360376470860758, - -0.03569696328026602 - ], - "translation_xyz_cm": [ - -0.8953804777239949, - 1.360376470860758, - -3.569696328026602 - ], - "translation_norm_m": 0.03923654191781868, - "rotation_rpy_deg_xyz": [ - 0.41489304741094685, - 0.6825534207726283, - 0.24871669863710305 - ], - "rotation_angle_deg": 0.8358487180140904, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007870624205977617, - 0.002144076896329228, - 0.05040281036765824 - ], - "translation_xyz_cm": [ - 0.7870624205977617, - 0.21440768963292278, - 5.040281036765824 - ], - "translation_norm_m": 0.05105866316392558, - "rotation_rpy_deg_xyz": [ - 1.272747216860497, - -0.13188145790893532, - -0.27776221463561995 - ], - "rotation_angle_deg": 1.3090501901544653, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011194570926770453, - 0.011583514105244053, - 0.010653817949428143 - ], - "translation_xyz_cm": [ - -1.1194570926770453, - 1.1583514105244053, - 1.0653817949428144 - ], - "translation_norm_m": 0.019313209317988543, - "rotation_rpy_deg_xyz": [ - 1.2010993705423756, - 0.27514912949213594, - 0.40191287864508757 - ], - "rotation_angle_deg": 1.2952040285997868, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.020684725457930764, - 0.019878137695423348, - 0.08942117765505007 - ], - "translation_xyz_cm": [ - 2.0684725457930764, - 1.9878137695423348, - 8.942117765505007 - ], - "translation_norm_m": 0.09391030422016641, - "rotation_rpy_deg_xyz": [ - 1.9108814481661178, - -0.3631591326192583, - -0.5033711944090471 - ], - "rotation_angle_deg": 2.007635858776786, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004825788624532201, - 0.012647288702589021, - 0.022696958325673477 - ], - "translation_xyz_cm": [ - 0.4825788624532201, - 1.2647288702589021, - 2.269695832567348 - ], - "translation_norm_m": 0.026427146357725778, - "rotation_rpy_deg_xyz": [ - 1.6256117406180348, - 0.3776610642685676, - 0.19717657379323422 - ], - "rotation_angle_deg": 1.6798794384200926, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008065753351425009, - 0.012571376328001094, - 0.006932519478819718 - ], - "translation_xyz_cm": [ - 0.8065753351425009, - 1.2571376328001094, - 0.6932519478819719 - ], - "translation_norm_m": 0.016466806193991136, - "rotation_rpy_deg_xyz": [ - 0.7217956486836289, - 0.9303576135000602, - -0.4999437774749251 - ], - "rotation_angle_deg": 1.2815370898367058, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00021380785700086946, - -0.01566282010952208, - 0.008218073243487764 - ], - "translation_xyz_cm": [ - -0.021380785700086946, - -1.566282010952208, - 0.8218073243487765 - ], - "translation_norm_m": 0.017689159827936826, - "rotation_rpy_deg_xyz": [ - -0.7075662959260186, - -0.23763831692452306, - -0.6986480954089979 - ], - "rotation_angle_deg": 1.0233640031331395, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0057233637376201685, - 0.04021721389432631, - 0.06780244443790286 - ], - "translation_xyz_cm": [ - -0.5723363737620168, - 4.021721389432631, - 6.780244443790286 - ], - "translation_norm_m": 0.07904019646768347, - "rotation_rpy_deg_xyz": [ - -1.2907472905985025, - -0.5517341215701028, - 0.6104702705434002 - ], - "rotation_angle_deg": 1.5282322456402084, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021631650330897756, - 0.024223110657609404, - 0.051484301851855055 - ], - "translation_xyz_cm": [ - 2.1631650330897756, - 2.4223110657609404, - 5.148430185185505 - ], - "translation_norm_m": 0.06087134566560809, - "rotation_rpy_deg_xyz": [ - -0.4835581729566882, - -0.2401659010034725, - 0.49148012414418346 - ], - "rotation_angle_deg": 0.7294261829939989, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.00943320022592653, - -0.025082137160485574, - 0.023663630168648024 - ], - "translation_xyz_cm": [ - -0.943320022592653, - -2.5082137160485574, - 2.366363016864802 - ], - "translation_norm_m": 0.035750052640498034, - "rotation_rpy_deg_xyz": [ - 0.7381529204936975, - -0.7167843970602933, - -0.1282345714193611 - ], - "rotation_angle_deg": 1.0362924220082856, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004587380603610747, - 7.886690298652965e-05, - 0.03217901899295324 - ], - "translation_xyz_cm": [ - -0.4587380603610747, - 0.007886690298652965, - 3.217901899295324 - ], - "translation_norm_m": 0.03250445421999293, - "rotation_rpy_deg_xyz": [ - 0.43361093468588424, - -1.2856382988989365, - 0.23437117461102247 - ], - "rotation_angle_deg": 1.377709699166698, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015418282185852394, - 0.007415408509479693, - 0.03422610211692746 - ], - "translation_xyz_cm": [ - -1.5418282185852394, - 0.7415408509479693, - 3.422610211692746 - ], - "translation_norm_m": 0.03826405330128244, - "rotation_rpy_deg_xyz": [ - -0.8156949715073674, - -1.278405187244089, - 0.17367512865310875 - ], - "rotation_angle_deg": 1.5253363205937427, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.006834019629686883, - 0.01892379575102332, - -0.05033551888354166 - ], - "translation_xyz_cm": [ - 0.6834019629686883, - 1.892379575102332, - -5.033551888354166 - ], - "translation_norm_m": 0.05420773313099131, - "rotation_rpy_deg_xyz": [ - -0.3566702148265097, - -0.5713740619511016, - 0.08737319383542423 - ], - "rotation_angle_deg": 0.6789728425166692, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005863634973002352, - 0.0035619305910778998, - -0.018952262797933737 - ], - "translation_xyz_cm": [ - -0.5863634973002352, - 0.35619305910779, - -1.8952262797933737 - ], - "translation_norm_m": 0.020155838603099996, - "rotation_rpy_deg_xyz": [ - -0.00031499297290635736, - -0.2468232074603096, - -0.05138302906035575 - ], - "rotation_angle_deg": 0.25211520437696516, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01005047911072432, - 0.022713793358650536, - -0.027032834504322673 - ], - "translation_xyz_cm": [ - 1.005047911072432, - 2.2713793358650536, - -2.7032834504322674 - ], - "translation_norm_m": 0.036711070270869, - "rotation_rpy_deg_xyz": [ - 0.8689029352651022, - 0.19617358650815822, - -0.14711017514853503 - ], - "rotation_angle_deg": 0.9030804350118543, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014699951084098828, - 0.012221483594132443, - -0.029648448532144846 - ], - "translation_xyz_cm": [ - 1.4699951084098828, - 1.2221483594132443, - -2.9648448532144847 - ], - "translation_norm_m": 0.035277240871130905, - "rotation_rpy_deg_xyz": [ - 0.9019490624083181, - 0.20421578872188886, - -0.08154213830071559 - ], - "rotation_angle_deg": 0.9285076482037994, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003298723518240898, - 0.0020250006385073016, - 0.023284416689010823 - ], - "translation_xyz_cm": [ - 0.3298723518240898, - 0.20250006385073016, - 2.3284416689010823 - ], - "translation_norm_m": 0.02360394596213176, - "rotation_rpy_deg_xyz": [ - 1.161154845754953, - -0.17431366298870507, - 0.019552097048139885 - ], - "rotation_angle_deg": 1.174357752359419, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.04135761050355713, - "improved_pairs": 31, - "worsened_pairs": 35, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.029706550191235692, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152188350905, - -0.00132483596826191, - 0.7182305054498935 - ], - "rotation_rpy_deg_xyz": [ - -0.6865945926762015, - 1.304106599014521, - -0.8334414989727543 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.09932272291285332, - "median": 0.05297050764680543, - "p90": 0.15820266783221976, - "p95": 0.21443102009687565, - "max": 0.3265150762005175 - }, - "rotation_deg": { - "rms": 1.0461846579706375, - "median": 0.8428295445991012, - "p90": 1.6329497783194329, - "p95": 1.871841326847414, - "max": 2.2453346006598824 - }, - "normalized_pair_score": { - "rms": 2.885136161262053, - "median": 2.4023798861451553, - "p90": 4.494411271243221, - "p95": 4.861583298952004, - "max": 6.5795785541710154 - }, - "normalized_global_rms": 2.885136161262053 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012945125910301614, - 0.0139336649564471, - 0.0772184668148804 - ], - "translation_xyz_cm": [ - -1.2945125910301614, - 1.39336649564471, - 7.7218466814880395 - ], - "translation_norm_m": 0.07952619015892104, - "rotation_rpy_deg_xyz": [ - -0.5097760994728473, - -0.12912853856676368, - 0.025158131951224145 - ], - "rotation_angle_deg": 0.5264501536349752, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6476453039285432, - "median": 0.7594633089830762, - "p90": 2.329487946106142, - "p95": 3.8537501645923045, - "max": 5.457199431160461 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.0059241016060888885, - "p90": 0.053409267341990724, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012945125910301614, - 0.0139336649564471, - 0.0772184668148804 - ], - "translation_xyz_cm": [ - -1.2945125910301614, - 1.39336649564471, - 7.7218466814880395 - ], - "translation_norm_m": 0.07952619015892104, - "rotation_rpy_deg_xyz": [ - -0.5097760994728473, - -0.12912853856676368, - 0.025158131951224145 - ], - "rotation_angle_deg": 0.5264501536349752, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019842367959444496, - -0.014866617413089145, - 0.1316251986695021 - ], - "translation_xyz_cm": [ - 1.9842367959444496, - -1.4866617413089145, - 13.162519866950209 - ], - "translation_norm_m": 0.13394001942784334, - "rotation_rpy_deg_xyz": [ - -0.2640015191939441, - -0.2443926360888103, - -0.3455133188999571 - ], - "rotation_angle_deg": 0.4991919434350986, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.031933271891301906, - 0.008452300672117552, - 0.10827736429768191 - ], - "translation_xyz_cm": [ - 3.1933271891301906, - 0.8452300672117552, - 10.82773642976819 - ], - "translation_norm_m": 0.1132040761615438, - "rotation_rpy_deg_xyz": [ - -0.18581872088047238, - -0.3344855949792437, - -0.40083989933243136 - ], - "rotation_angle_deg": 0.5545412208792635, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03402353510023726, - -0.018502229709528584, - 0.047571348502387874 - ], - "translation_xyz_cm": [ - 3.4023535100237257, - -1.8502229709528584, - 4.757134850238788 - ], - "translation_norm_m": 0.06134302440601441, - "rotation_rpy_deg_xyz": [ - 0.27858037335093544, - 0.058855562691976955, - -0.351286454619393 - ], - "rotation_angle_deg": 0.45229795458630645, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0452843945554362, - 0.01183021382921745, - 0.025673599860923067 - ], - "translation_xyz_cm": [ - 4.52843945554362, - 1.183021382921745, - 2.5673599860923066 - ], - "translation_norm_m": 0.05338318161477655, - "rotation_rpy_deg_xyz": [ - 0.42037335763404376, - 0.21187738375171225, - -0.38397378613114397 - ], - "rotation_angle_deg": 0.6079782227248322, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.011650739653164127, - 0.009098944723108238, - -0.03060339733420401 - ], - "translation_xyz_cm": [ - 1.1650739653164126, - 0.9098944723108238, - -3.0603397334204008 - ], - "translation_norm_m": 0.033986739442540756, - "rotation_rpy_deg_xyz": [ - 0.6251758485220985, - 0.0547086632500239, - 0.13126801773573268 - ], - "rotation_angle_deg": 0.6410854934369539, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.004893346276888763, - 0.020940819214246148, - -0.009270416577605835 - ], - "translation_xyz_cm": [ - 0.48933462768887626, - 2.094081921424615, - -0.9270416577605834 - ], - "translation_norm_m": 0.023418013807144936, - "rotation_rpy_deg_xyz": [ - 0.2832035718683816, - 0.18266221061755814, - -0.03430570568825576 - ], - "rotation_angle_deg": 0.33878832622757693, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.034051428336521306, - -3.0194447016740344e-05, - -0.0701874735568548 - ], - "translation_xyz_cm": [ - -3.4051428336521306, - -0.0030194447016740344, - -7.01874735568548 - ], - "translation_norm_m": 0.07801142305942167, - "rotation_rpy_deg_xyz": [ - 0.6228614425523304, - 0.4121775244591239, - 0.5323440753923214 - ], - "rotation_angle_deg": 0.9158853109582283, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0323842508309532, - -0.017716335583819798, - -0.1274628690925247 - ], - "translation_xyz_cm": [ - -3.23842508309532, - -1.7716335583819798, - -12.746286909252468 - ], - "translation_norm_m": 0.132700381482868, - "rotation_rpy_deg_xyz": [ - 0.7483023060054081, - 0.18977262875379436, - 0.3965943161801948 - ], - "rotation_angle_deg": 0.8673356876104018, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.032317051549761416, - -0.020278343682710004, - -0.05044676905918737 - ], - "translation_xyz_cm": [ - -3.2317051549761415, - -2.0278343682710003, - -5.044676905918737 - ], - "translation_norm_m": 0.06324934428035618, - "rotation_rpy_deg_xyz": [ - 0.5083624656871717, - 0.2837996282875649, - 0.5844844192085773 - ], - "rotation_angle_deg": 0.824088246842196, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03960599232255134, - -0.03819349402507172, - -0.07575201486596278 - ], - "translation_xyz_cm": [ - -3.960599232255134, - -3.8193494025071715, - -7.575201486596278 - ], - "translation_norm_m": 0.09362555938391091, - "rotation_rpy_deg_xyz": [ - 0.6939128257794969, - 0.6746161975739622, - 0.49920995653775374 - ], - "rotation_angle_deg": 1.087079763231695, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013817621632674283, - -0.010366958639124929, - -0.02979813970936399 - ], - "translation_xyz_cm": [ - -1.3817621632674284, - -1.036695863912493, - -2.979813970936399 - ], - "translation_norm_m": 0.03444313616887769, - "rotation_rpy_deg_xyz": [ - 0.34166753559265733, - 0.23259292708536114, - -0.08818221586065197 - ], - "rotation_angle_deg": 0.42276990528599845, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.010436692547034776, - -0.0029535919013300577, - -0.21123504859570577 - ], - "translation_xyz_cm": [ - 1.0436692547034776, - -0.29535919013300577, - -21.123504859570577 - ], - "translation_norm_m": 0.21151334239633943, - "rotation_rpy_deg_xyz": [ - 0.06250931347542805, - -0.07146137262118804, - 0.2946297264651946 - ], - "rotation_angle_deg": 0.3095864465253292, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.008846300521013317, - 0.017459753820782593, - -0.19631574938963883 - ], - "translation_xyz_cm": [ - 0.8846300521013317, - 1.7459753820782593, - -19.631574938963883 - ], - "translation_norm_m": 0.19728906075808128, - "rotation_rpy_deg_xyz": [ - 0.13831500776812922, - -0.26212631692122484, - 0.39775293150977953 - ], - "rotation_angle_deg": 0.49628615587850644, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009061297463201279, - 0.005307651564726956, - -0.13152790035363365 - ], - "translation_xyz_cm": [ - -0.9061297463201279, - 0.5307651564726956, - -13.152790035363365 - ], - "translation_norm_m": 0.13194645447409548, - "rotation_rpy_deg_xyz": [ - 0.6104211446716649, - -0.5228623248490306, - -0.09657127205210252 - ], - "rotation_angle_deg": 0.8091874356272394, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.007550045605277944, - 0.015536496721341275, - -0.13284431943565833 - ], - "translation_xyz_cm": [ - 0.7550045605277944, - 1.5536496721341275, - -13.284431943565833 - ], - "translation_norm_m": 0.13396267810602047, - "rotation_rpy_deg_xyz": [ - -0.7895954188094686, - 0.6255185088090308, - 0.2915613590483623 - ], - "rotation_angle_deg": 1.0498796689466594, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.011823409742551416, - -0.002294270657271502, - -0.05593963175024408 - ], - "translation_xyz_cm": [ - -1.1823409742551416, - -0.22942706572715021, - -5.593963175024408 - ], - "translation_norm_m": 0.05722149155817237, - "rotation_rpy_deg_xyz": [ - -0.6895487807968242, - 0.09652953839518408, - -0.21085531838688637 - ], - "rotation_angle_deg": 0.7273306147045157, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.009671278471361955, - -0.01927477031759959, - 0.07069427307416157 - ], - "translation_xyz_cm": [ - -0.9671278471361955, - -1.927477031759959, - 7.069427307416157 - ], - "translation_norm_m": 0.07391028780590002, - "rotation_rpy_deg_xyz": [ - 0.311799520294898, - -0.4307327869000083, - -0.4850121178788741 - ], - "rotation_angle_deg": 0.7189210013378864, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - -9.965853382298828e-05, - -0.0022221435788458144, - 0.0032574646187508785 - ], - "translation_xyz_cm": [ - -0.009965853382298828, - -0.22221435788458144, - 0.3257464618750878 - ], - "translation_norm_m": 0.003944480910181115, - "rotation_rpy_deg_xyz": [ - 0.2131919550411292, - -0.39277401331860123, - -0.47959342157059537 - ], - "rotation_angle_deg": 0.6550036855480482, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.002953646285696887, - 0.01476418229863441, - -0.06643293439538378 - ], - "translation_xyz_cm": [ - 0.2953646285696887, - 1.476418229863441, - -6.643293439538378 - ], - "translation_norm_m": 0.06811783817554463, - "rotation_rpy_deg_xyz": [ - -0.6495437847368251, - -0.4741436194119343, - -0.3064987278423279 - ], - "rotation_angle_deg": 0.8615708423560063, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.009841658174921719, - 0.020368149073090702, - -0.06075354099602698 - ], - "translation_xyz_cm": [ - 0.9841658174921719, - 2.03681490730907, - -6.075354099602698 - ], - "translation_norm_m": 0.06482833081185709, - "rotation_rpy_deg_xyz": [ - 0.07744588481441383, - -0.015492961591267335, - 0.005952978997094564 - ], - "rotation_angle_deg": 0.0792051735389124, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011587326184248181, - 0.03992182974893721, - -0.1070541678289783 - ], - "translation_xyz_cm": [ - 1.1587326184248181, - 3.992182974893721, - -10.70541678289783 - ], - "translation_norm_m": 0.11484168872042218, - "rotation_rpy_deg_xyz": [ - -0.8914459256017848, - -0.25956390632414356, - 0.16800492664726585 - ], - "rotation_angle_deg": 0.9431831507113868, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006171727372332958, - 0.016599561665977647, - -0.0506658525881516 - ], - "translation_xyz_cm": [ - 0.6171727372332958, - 1.6599561665977647, - -5.06658525881516 - ], - "translation_norm_m": 0.05367182021084534, - "rotation_rpy_deg_xyz": [ - -0.9199126793112754, - -0.11240312769235343, - 0.1657357544157429 - ], - "rotation_angle_deg": 0.9412981298122861, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0030940183725931547, - -0.016654458220899393, - -0.1583890974687375 - ], - "translation_xyz_cm": [ - -0.30940183725931547, - -1.6654458220899393, - -15.83890974687375 - ], - "translation_norm_m": 0.15929234170318063, - "rotation_rpy_deg_xyz": [ - -0.4817501823618205, - 1.548564668452001, - -0.33407331583570055 - ], - "rotation_angle_deg": 1.6544997312129466, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.004084656094918038, - 0.011986886340916714, - -0.03257713362235215 - ], - "translation_xyz_cm": [ - -0.40846560949180377, - 1.1986886340916714, - -3.257713362235215 - ], - "translation_norm_m": 0.03495195981075158, - "rotation_rpy_deg_xyz": [ - 0.5465337099533609, - 0.34273865900405104, - 0.20150193582407014 - ], - "rotation_angle_deg": 0.6753605116524832, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.012491212556688058, - 0.020896949387557262, - -0.028124763990755988 - ], - "translation_xyz_cm": [ - 1.2491212556688058, - 2.089694938755726, - -2.812476399075599 - ], - "translation_norm_m": 0.03719832300491806, - "rotation_rpy_deg_xyz": [ - 0.7542603942874239, - 0.8180167070875887, - 0.1913842491981992 - ], - "rotation_angle_deg": 1.1281029401099434, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.008449564119442421, - 0.004198158910853511, - -0.01454756102090931 - ], - "translation_xyz_cm": [ - -0.8449564119442421, - 0.4198158910853511, - -1.454756102090931 - ], - "translation_norm_m": 0.017339296517057068, - "rotation_rpy_deg_xyz": [ - -0.3216615076558454, - 2.0683417272394546, - 0.6411182393595277 - ], - "rotation_angle_deg": 2.190872838085688, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0155548354014039, - 0.014804651712225225, - -0.0036216034364122893 - ], - "translation_xyz_cm": [ - 1.55548354014039, - 1.4804651712225225, - -0.36216034364122895 - ], - "translation_norm_m": 0.021777204323229705, - "rotation_rpy_deg_xyz": [ - 0.3540208269514107, - 0.2383169732938207, - -0.013627243974260442 - ], - "rotation_angle_deg": 0.42700270758991316, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0035179195826497978, - 0.006785560659960055, - 0.019411094478540097 - ], - "translation_xyz_cm": [ - -0.3517919582649798, - 0.6785560659960055, - 1.9411094478540096 - ], - "translation_norm_m": 0.020861691698297106, - "rotation_rpy_deg_xyz": [ - 0.13982392787711678, - 1.5567651178246398, - 0.47915510705051045 - ], - "rotation_angle_deg": 1.6342650258778777, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0118066569717028, - 0.0055073219783396965, - 0.24095687696111398 - ], - "translation_xyz_cm": [ - 1.18066569717028, - 0.5507321978339696, - 24.095687696111398 - ], - "translation_norm_m": 0.2413088152121136, - "rotation_rpy_deg_xyz": [ - 0.046556561628215545, - -0.23178419067153486, - -0.2869611321653062 - ], - "rotation_angle_deg": 0.3717310181594892, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.002592826517245017, - -0.008309606570184369, - 0.031875102810879935 - ], - "translation_xyz_cm": [ - 0.2592826517245017, - -0.8309606570184369, - 3.1875102810879934 - ], - "translation_norm_m": 0.03304231362819417, - "rotation_rpy_deg_xyz": [ - 0.37099545134050604, - 1.307421871876041, - 0.5176758053668802 - ], - "rotation_angle_deg": 1.4527824345568767, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03158579660946648, - -0.009548356701029714, - 0.22778863339299332 - ], - "translation_xyz_cm": [ - 3.1585796609466477, - -0.9548356701029714, - 22.77886333929933 - ], - "translation_norm_m": 0.2301662337663633, - "rotation_rpy_deg_xyz": [ - 0.3880015617715102, - -0.46959375266784853, - -0.24683597011303493 - ], - "rotation_angle_deg": 0.6566621160934105, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.030425509664320005, - 0.0037066700703225486, - 0.3250732901129927 - ], - "translation_xyz_cm": [ - 3.0425509664320005, - 0.37066700703225486, - 32.50732901129927 - ], - "translation_norm_m": 0.3265150762005175, - "rotation_rpy_deg_xyz": [ - -0.016421787566930572, - 0.3318022447179004, - -0.22619292465666857 - ], - "rotation_angle_deg": 0.4018755889623236, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006534440510578943, - 0.012921697652590103, - 0.1564443149764776 - ], - "translation_xyz_cm": [ - 0.6534440510578943, - 1.2921697652590103, - 15.644431497647759 - ], - "translation_norm_m": 0.1571129939612589, - "rotation_rpy_deg_xyz": [ - 0.9608554285447461, - -1.5192763903860977, - -0.7435980713532221 - ], - "rotation_angle_deg": 1.9404475910359964, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013709756778841342, - 0.024825280247476655, - 0.21352856955930252 - ], - "translation_xyz_cm": [ - -1.3709756778841342, - 2.4825280247476655, - 21.352856955930253 - ], - "translation_norm_m": 0.21540357933038773, - "rotation_rpy_deg_xyz": [ - 0.8700771598850835, - -0.506026291618741, - -0.6970695574621423 - ], - "rotation_angle_deg": 1.2221411061286953, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0020784437423113644, - -0.011871309450006251, - 0.10941984701942059 - ], - "translation_xyz_cm": [ - 0.20784437423113644, - -1.187130945000625, - 10.94198470194206 - ], - "translation_norm_m": 0.11008156447925858, - "rotation_rpy_deg_xyz": [ - -0.6653485464506672, - 0.5855677502456926, - 0.0056688928826917956 - ], - "rotation_angle_deg": 0.8863662385562447, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0004948746440140428, - -0.004667652754462015, - -0.042119423071664754 - ], - "translation_xyz_cm": [ - -0.04948746440140428, - -0.4667652754462015, - -4.211942307166475 - ], - "translation_norm_m": 0.042380156713247415, - "rotation_rpy_deg_xyz": [ - -0.4184808869362607, - 0.5329224436981862, - 0.0917172513454058 - ], - "rotation_angle_deg": 0.684032365585507, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0011130991187053851, - 0.026653758424031393, - 0.0405893338457303 - ], - "translation_xyz_cm": [ - -0.11130991187053851, - 2.6653758424031393, - 4.05893338457303 - ], - "translation_norm_m": 0.04857114215061073, - "rotation_rpy_deg_xyz": [ - -0.7643956663987446, - -0.15094974681174766, - -0.7385242507520419 - ], - "rotation_angle_deg": 1.0742360850849277, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012807394822990759, - -0.041534070753315167, - -0.011285466984450154 - ], - "translation_xyz_cm": [ - 1.2807394822990759, - -4.153407075331517, - -1.1285466984450154 - ], - "translation_norm_m": 0.0449051239899243, - "rotation_rpy_deg_xyz": [ - 0.21832176956990013, - -0.013724806516689385, - -0.6450878905659495 - ], - "rotation_angle_deg": 0.6811438245697251, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0015106002219833492, - 0.012776790224116041, - 0.008922194456519442 - ], - "translation_xyz_cm": [ - 0.15106002219833492, - 1.2776790224116041, - 0.8922194456519441 - ], - "translation_norm_m": 0.01565675047325177, - "rotation_rpy_deg_xyz": [ - -0.015387696620196482, - 0.05868344569459291, - 0.14402265457584476 - ], - "rotation_angle_deg": 0.15628602282208068, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.005983894556965019, - -0.012592910003347446, - -0.011290312074711512 - ], - "translation_xyz_cm": [ - 0.5983894556965019, - -1.2592910003347446, - -1.1290312074711513 - ], - "translation_norm_m": 0.017940443783966444, - "rotation_rpy_deg_xyz": [ - -1.3006641369602876, - -1.0747709400033723, - 0.15306204509024643 - ], - "rotation_angle_deg": 1.6930747226172207, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.003482734365272133, - 0.0021124671677758416, - 0.059658142631649015 - ], - "translation_xyz_cm": [ - 0.3482734365272133, - 0.21124671677758416, - 5.965814263164901 - ], - "translation_norm_m": 0.05979703954588518, - "rotation_rpy_deg_xyz": [ - -0.1836152884096103, - -0.4605521882433464, - -0.1354186107262789 - ], - "rotation_angle_deg": 0.5141601544920775, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.010672009963219153, - -0.03209390774647375, - 0.020673276042493707 - ], - "translation_xyz_cm": [ - -1.0672009963219153, - -3.2093907746473747, - 2.0673276042493707 - ], - "translation_norm_m": 0.03963956424361097, - "rotation_rpy_deg_xyz": [ - 1.2739169133989858, - -0.15441412885717196, - -0.2014069531115573 - ], - "rotation_angle_deg": 1.2986834208932883, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012954721643003264, - 0.02078865823610565, - 0.04296889640638764 - ], - "translation_xyz_cm": [ - -1.2954721643003264, - 2.078865823610565, - 4.2968896406387636 - ], - "translation_norm_m": 0.04946027883552794, - "rotation_rpy_deg_xyz": [ - 0.191791910955383, - 1.037596898585814, - -0.2816015854053235 - ], - "rotation_angle_deg": 1.0925501090259304, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0017320874770283545, - -0.0318405703494562, - -0.05194203272838931 - ], - "translation_xyz_cm": [ - -0.17320874770283545, - -3.18405703494562, - -5.194203272838931 - ], - "translation_norm_m": 0.06094913298123128, - "rotation_rpy_deg_xyz": [ - 0.6933490618424856, - 0.1618118341226918, - -0.08461018679361057 - ], - "rotation_angle_deg": 0.7171053899483946, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01391008590369136, - 0.006883954859807417, - -0.11497291151666617 - ], - "translation_xyz_cm": [ - 1.391008590369136, - 0.6883954859807417, - -11.497291151666616 - ], - "translation_norm_m": 0.11601573042902022, - "rotation_rpy_deg_xyz": [ - 0.3509375743770506, - 0.6961878422255168, - -0.024526521627571626 - ], - "rotation_angle_deg": 0.780089292035612, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0020694300338002236, - 0.020336546505490105, - -0.1157102948138237 - ], - "translation_xyz_cm": [ - 0.20694300338002236, - 2.0336546505490105, - -11.57102948138237 - ], - "translation_norm_m": 0.117502042494319, - "rotation_rpy_deg_xyz": [ - 0.2090324085472653, - 1.1209365516436534, - 0.22274574759812166 - ], - "rotation_angle_deg": 1.1614193966480408, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0213520973639163, - 0.0176725688918955, - -0.04235472267841239 - ], - "translation_xyz_cm": [ - -2.13520973639163, - 1.7672568891895502, - -4.2354722678412395 - ], - "translation_norm_m": 0.05061772699600581, - "rotation_rpy_deg_xyz": [ - 0.13180225970325057, - -0.07541314713550007, - 0.07360727442891095 - ], - "rotation_angle_deg": 0.16878913744897628, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.034560413559181935, - 0.021197905163034325, - -0.07151105424639809 - ], - "translation_xyz_cm": [ - -3.4560413559181935, - 2.1197905163034325, - -7.151105424639809 - ], - "translation_norm_m": 0.08220464857971217, - "rotation_rpy_deg_xyz": [ - 0.4535735237818598, - 0.5271060340707374, - 0.32192781941085574 - ], - "rotation_angle_deg": 0.7654156935582683, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010243661748970012, - 0.013129261440568252, - -0.03345153435302803 - ], - "translation_xyz_cm": [ - -1.0243661748970012, - 1.3129261440568252, - -3.345153435302803 - ], - "translation_norm_m": 0.03736730205104348, - "rotation_rpy_deg_xyz": [ - 0.44518602143587854, - 0.5795776437935242, - 0.24721901257678483 - ], - "rotation_angle_deg": 0.7707802929569919, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.005718154223623317, - -0.0017491995202032484, - 0.04994894288061716 - ], - "translation_xyz_cm": [ - 0.5718154223623317, - -0.17491995202032484, - 4.994894288061716 - ], - "translation_norm_m": 0.05030560487239743, - "rotation_rpy_deg_xyz": [ - 1.5809314832406116, - -0.29726000660992996, - -0.27714107576104496 - ], - "rotation_angle_deg": 1.6316345307609883, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.012700360892276219, - 0.006611294775778154, - 0.020586448539499147 - ], - "translation_xyz_cm": [ - -1.270036089227622, - 0.6611294775778154, - 2.0586448539499145 - ], - "translation_norm_m": 0.025076089186229524, - "rotation_rpy_deg_xyz": [ - 1.5679145729741613, - 0.16764841017804855, - 0.4061841976724548 - ], - "rotation_angle_deg": 1.6277506145260534, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.018342903511085584, - 0.01773067143272833, - 0.08038875675188475 - ], - "translation_xyz_cm": [ - 1.8342903511085584, - 1.7730671432728329, - 8.038875675188475 - ], - "translation_norm_m": 0.08433973577612193, - "rotation_rpy_deg_xyz": [ - 2.1165886809155556, - -0.560153137601747, - -0.5083248079801407 - ], - "rotation_angle_deg": 2.2453346006598824, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.002415849532795278, - 0.008663138522507552, - 0.031170013886686485 - ], - "translation_xyz_cm": [ - 0.24158495327952778, - 0.8663138522507552, - 3.1170013886686485 - ], - "translation_norm_m": 0.03244157924210055, - "rotation_rpy_deg_xyz": [ - 1.911407262567204, - 0.1998505689176781, - 0.19574724739182994 - ], - "rotation_angle_deg": 1.9314301949241452, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.006453544999329264, - 0.007631657257044955, - 0.017287709076919233 - ], - "translation_xyz_cm": [ - 0.6453544999329264, - 0.7631657257044955, - 1.7287709076919233 - ], - "translation_norm_m": 0.019968858772487986, - "rotation_rpy_deg_xyz": [ - 1.0852257905014293, - 0.8178517107316483, - -0.494996816289085 - ], - "rotation_angle_deg": 1.4488804877580408, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0015748617353776861, - -0.01591356370236835, - 0.011406242504737311 - ], - "translation_xyz_cm": [ - -0.15748617353776861, - -1.591356370236835, - 1.1406242504737312 - ], - "translation_norm_m": 0.0196424048240476, - "rotation_rpy_deg_xyz": [ - -0.6804153134156338, - -0.33538937802416846, - -0.6981886534705121 - ], - "rotation_angle_deg": 1.0323230167723803, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0041012404220150955, - 0.03997490777605517, - 0.0572776244940139 - ], - "translation_xyz_cm": [ - -0.41012404220150955, - 3.997490777605517, - 5.72776244940139 - ], - "translation_norm_m": 0.06996813340643401, - "rotation_rpy_deg_xyz": [ - -1.266606310436814, - -0.45351511621775104, - 0.6101756290213036 - ], - "rotation_angle_deg": 1.475174206575064, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024649105865161225, - 0.022638411081818077, - 0.03415905684692201 - ], - "translation_xyz_cm": [ - 2.4649105865161225, - 2.2638411081818077, - 3.415905684692201 - ], - "translation_norm_m": 0.04782172352532433, - "rotation_rpy_deg_xyz": [ - -0.34112986197911416, - -0.04571952165030793, - 0.4959893738590014 - ], - "rotation_angle_deg": 0.6035971825803282, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.007474437586231453, - -0.025640017459197972, - 0.018245072950718443 - ], - "translation_xyz_cm": [ - -0.7474437586231453, - -2.5640017459197972, - 1.8245072950718442 - ], - "translation_norm_m": 0.032344402908625225, - "rotation_rpy_deg_xyz": [ - 0.7941862533680263, - -0.5750283955612969, - -0.12311561392549839 - ], - "rotation_angle_deg": 0.9877043840285485, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0027644190789093415, - -0.00030635002974560566, - 0.02663515331165689 - ], - "translation_xyz_cm": [ - -0.27644190789093415, - -0.030635002974560566, - 2.663515331165689 - ], - "translation_norm_m": 0.026779978624338556, - "rotation_rpy_deg_xyz": [ - 0.47542849183877006, - -1.1602434177876486, - 0.23804162607315923 - ], - "rotation_angle_deg": 1.2771619340055451, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.012510152338940372, - 0.005030148000313817, - 0.025072876095915256 - ], - "translation_xyz_cm": [ - -1.2510152338940372, - 0.5030148000313817, - 2.5072876095915255 - ], - "translation_norm_m": 0.02846849866378055, - "rotation_rpy_deg_xyz": [ - -0.6234485484604054, - -1.0756382447524488, - 0.1782870731150942 - ], - "rotation_angle_deg": 1.255138487977452, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008953552534015308, - 0.015236244061915594, - -0.04949764282183929 - ], - "translation_xyz_cm": [ - 0.8953552534015308, - 1.5236244061915594, - -4.94976428218393 - ], - "translation_norm_m": 0.0525578336788343, - "rotation_rpy_deg_xyz": [ - -0.05984897349848199, - -0.3936275826445443, - 0.09591926850075025 - ], - "rotation_angle_deg": 0.4094943094169885, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.003834211882641103, - 0.0027365181629508406, - -0.024154030829628463 - ], - "translation_xyz_cm": [ - -0.3834211882641103, - 0.27365181629508406, - -2.4154030829628463 - ], - "translation_norm_m": 0.024609082017332307, - "rotation_rpy_deg_xyz": [ - 0.06897507897604013, - -0.0925250187027215, - -0.047596027899326085 - ], - "rotation_angle_deg": 0.12481393820061966, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012374642815450976, - 0.020475395873511326, - -0.023438071298638907 - ], - "translation_xyz_cm": [ - 1.2374642815450976, - 2.0475395873511326, - -2.3438071298638907 - ], - "translation_norm_m": 0.03349204095284547, - "rotation_rpy_deg_xyz": [ - 1.035512430453766, - 0.39607799703816704, - -0.137252278260299 - ], - "rotation_angle_deg": 1.1175775606990446, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01593418521427825, - 0.011747792189998774, - -0.027823497872806937 - ], - "translation_xyz_cm": [ - 1.5934185214278251, - 1.1747792189998774, - -2.7823497872806935 - ], - "translation_norm_m": 0.034147560874247106, - "rotation_rpy_deg_xyz": [ - 0.9293433645487914, - 0.30811898096070195, - -0.07783140340052873 - ], - "rotation_angle_deg": 0.9823751186855719, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004425899201898398, - 0.0018738645585085756, - 0.02214557488886174 - ], - "translation_xyz_cm": [ - 0.4425899201898398, - 0.18738645585085756, - 2.214557488886174 - ], - "translation_norm_m": 0.0226611217570354, - "rotation_rpy_deg_xyz": [ - 1.179268176108766, - -0.08821806459370339, - 0.022905972350413053 - ], - "rotation_angle_deg": 1.182802535932146, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.029494769819405242, - "improved_pairs": 30, - "worsened_pairs": 36, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.013664187192618082, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.300266778135581, - 0.0024476764333135033, - 0.7159592638351174 - ], - "rotation_rpy_deg_xyz": [ - -0.9881056123574021, - 1.3997156446701597, - -0.8397697014302278 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10267526429269669, - "median": 0.05573474852997967, - "p90": 0.1602865349010675, - "p95": 0.2112722473315818, - "max": 0.34142095735067635 - }, - "rotation_deg": { - "rms": 1.0757093910702569, - "median": 0.8967455715431769, - "p90": 1.6699453976668024, - "p95": 1.8316094167681647, - "max": 2.6470410393405652 - }, - "normalized_pair_score": { - "rms": 2.9741363007059745, - "median": 2.4430918593251603, - "p90": 4.58439585460328, - "p95": 4.914396860809632, - "max": 7.05028166241884 - }, - "normalized_global_rms": 2.9741363007059745 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01201210641490108, - 0.01334901924793841, - 0.07419981593089706 - ], - "translation_xyz_cm": [ - -1.201210641490108, - 1.334901924793841, - 7.419981593089705 - ], - "translation_norm_m": 0.07634199171873722, - "rotation_rpy_deg_xyz": [ - -0.49591346529312486, - -0.0577837588917674, - 0.02590184941646954 - ], - "rotation_angle_deg": 0.49992704876652105, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7067898021773054, - "median": 0.7385055841034844, - "p90": 2.354962484664117, - "p95": 3.858143262184229, - "max": 5.772844678665988 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337456, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01201210641490108, - 0.01334901924793841, - 0.07419981593089706 - ], - "translation_xyz_cm": [ - -1.201210641490108, - 1.334901924793841, - 7.419981593089705 - ], - "translation_norm_m": 0.07634199171873722, - "rotation_rpy_deg_xyz": [ - -0.49591346529312486, - -0.0577837588917674, - 0.02590184941646954 - ], - "rotation_angle_deg": 0.49992704876652105, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021862949978100232, - -0.015659998822578736, - 0.12684165025370076 - ], - "translation_xyz_cm": [ - 2.1862949978100232, - -1.5659998822578736, - 12.684165025370076 - ], - "translation_norm_m": 0.12966120616418092, - "rotation_rpy_deg_xyz": [ - -0.2528550550344141, - -0.10091798351668403, - -0.3438003995990869 - ], - "rotation_angle_deg": 0.43871598020210434, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.035199996019546154, - 0.007997330344484688, - 0.10244616932184443 - ], - "translation_xyz_cm": [ - 3.5199996019546154, - 0.7997330344484688, - 10.244616932184442 - ], - "translation_norm_m": 0.10861958672879814, - "rotation_rpy_deg_xyz": [ - -0.19868474717859064, - -0.10954627505429712, - -0.3986106266322779 - ], - "rotation_angle_deg": 0.45882202317192805, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03494180931670199, - -0.018895917393885353, - 0.04495947950334158 - ], - "translation_xyz_cm": [ - 3.494180931670199, - -1.8895917393885353, - 4.495947950334158 - ], - "translation_norm_m": 0.059994504162403844, - "rotation_rpy_deg_xyz": [ - 0.2924084008623983, - 0.12968628982453115, - -0.34957185078247316 - ], - "rotation_angle_deg": 0.47408089673947634, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04735477326402682, - 0.011500591584786668, - 0.021906116918553833 - ], - "translation_xyz_cm": [ - 4.735477326402682, - 1.1500591584786668, - 2.1906116918553833 - ], - "translation_norm_m": 0.053428607656730166, - "rotation_rpy_deg_xyz": [ - 0.4294373434022533, - 0.36748260964463253, - -0.38033160599565324 - ], - "rotation_angle_deg": 0.6820247645837519, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.01553023680104168, - 0.009904717640053073, - -0.03464448261765626 - ], - "translation_xyz_cm": [ - 1.5530236801041681, - 0.9904717640053073, - -3.4644482617656256 - ], - "translation_norm_m": 0.03923686866291313, - "rotation_rpy_deg_xyz": [ - 0.5655602030660467, - 0.3540859117615814, - 0.13734785320144743 - ], - "rotation_angle_deg": 0.680895239725926, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.005964702932977736, - 0.02075799884975424, - -0.010453518345841488 - ], - "translation_xyz_cm": [ - 0.5964702932977737, - 2.075799884975424, - -1.0453518345841488 - ], - "translation_norm_m": 0.02399475449201171, - "rotation_rpy_deg_xyz": [ - 0.29778168470421745, - 0.26631104314602005, - -0.032314968504418444 - ], - "rotation_angle_deg": 0.40085449181485494, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03111689961543687, - 0.0004674914658625018, - -0.0719365739673613 - ], - "translation_xyz_cm": [ - -3.111689961543687, - 0.04674914658625018, - -7.19365739673613 - ], - "translation_norm_m": 0.07837952962419124, - "rotation_rpy_deg_xyz": [ - 0.6031904858690685, - 0.651406611542103, - 0.5379357967197737 - ], - "rotation_angle_deg": 1.0362651683815214, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.028516526816319193, - -0.016422869588027855, - -0.13024535797470094 - ], - "translation_xyz_cm": [ - -2.8516526816319194, - -1.6422869588027855, - -13.024535797470094 - ], - "translation_norm_m": 0.13433821578809663, - "rotation_rpy_deg_xyz": [ - 0.6691039462667512, - 0.5103535057172044, - 0.40337626552724254 - ], - "rotation_angle_deg": 0.9319137400775779, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.030349949538715018, - -0.020124665322709068, - -0.05128063114399952 - ], - "translation_xyz_cm": [ - -3.034994953871502, - -2.0124665322709068, - -5.128063114399952 - ], - "translation_norm_m": 0.06289534737864583, - "rotation_rpy_deg_xyz": [ - 0.5167377508331105, - 0.44288964255019486, - 0.588430494533235 - ], - "rotation_angle_deg": 0.8983672990723964, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03656102961034887, - -0.03750741780060207, - -0.07781152319335848 - ], - "translation_xyz_cm": [ - -3.656102961034887, - -3.750741780060207, - -7.781152319335847 - ], - "translation_norm_m": 0.09379844571158039, - "rotation_rpy_deg_xyz": [ - 0.6666234672158453, - 0.9279467816454481, - 0.5052759287908468 - ], - "rotation_angle_deg": 1.2471176687712298, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012544601411036575, - -0.010450218229439506, - -0.03105555497517807 - ], - "translation_xyz_cm": [ - -1.2544601411036576, - -1.0450218229439505, - -3.105555497517807 - ], - "translation_norm_m": 0.03508591712384041, - "rotation_rpy_deg_xyz": [ - 0.3564483591463069, - 0.3322855184981405, - -0.08576897185896296 - ], - "rotation_angle_deg": 0.4949770877737651, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.013931988407110907, - -0.0006444318563227497, - -0.2096695288735549 - ], - "translation_xyz_cm": [ - 1.3931988407110907, - -0.06444318563227497, - -20.96695288735549 - ], - "translation_norm_m": 0.21013287922515073, - "rotation_rpy_deg_xyz": [ - -0.06938403386267719, - 0.29112209058270994, - 0.2967942419342959 - ], - "rotation_angle_deg": 0.42161292665155725, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.011785767634175048, - 0.019039169330351723, - -0.19415149078297986 - ], - "translation_xyz_cm": [ - 1.1785767634175048, - 1.9039169330351724, - -19.415149078297986 - ], - "translation_norm_m": 0.19543847026818975, - "rotation_rpy_deg_xyz": [ - 0.08179528302036033, - 0.03352476496024565, - 0.40130819236289794 - ], - "rotation_angle_deg": 0.41090559105307395, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.004773177990423982, - 0.007967833816299674, - -0.1349174140850391 - ], - "translation_xyz_cm": [ - -0.47731779904239824, - 0.7967833816299674, - -13.49174140850391 - ], - "translation_norm_m": 0.13523674880462908, - "rotation_rpy_deg_xyz": [ - 0.4270816319087594, - -0.13389964977785807, - -0.09169066600690373 - ], - "rotation_angle_deg": 0.4567749707185019, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00916431181933186, - 0.016125859418411936, - -0.1371060834485559 - ], - "translation_xyz_cm": [ - 0.9164311819331861, - 1.6125859418411936, - -13.71060834485559 - ], - "translation_norm_m": 0.13835500016879299, - "rotation_rpy_deg_xyz": [ - -0.7769448904358175, - 0.7579471378712342, - 0.29198480762629975 - ], - "rotation_angle_deg": 1.1253319541436468, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.008383313567782213, - -0.0014504009327580558, - -0.06367479926625445 - ], - "translation_xyz_cm": [ - -0.8383313567782213, - -0.14504009327580558, - -6.367479926625445 - ], - "translation_norm_m": 0.06424066991275314, - "rotation_rpy_deg_xyz": [ - -0.7335776051227884, - 0.37585489111938325, - -0.21128113414184294 - ], - "rotation_angle_deg": 0.8503077636397108, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.007593297980498015, - -0.019753319912202305, - 0.06957603007914048 - ], - "translation_xyz_cm": [ - -0.7593297980498015, - -1.9753319912202305, - 6.957603007914049 - ], - "translation_norm_m": 0.07272328226467714, - "rotation_rpy_deg_xyz": [ - 0.32051812605824614, - -0.27355809453749047, - -0.48164102416165044 - ], - "rotation_angle_deg": 0.6393791326862639, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.002833941324650091, - -0.0020249479444029994, - 0.00040197427464842145 - ], - "translation_xyz_cm": [ - 0.2833941324650091, - -0.20249479444029994, - 0.040197427464842145 - ], - "translation_norm_m": 0.003506168981464038, - "rotation_rpy_deg_xyz": [ - 0.1993671718848384, - -0.16575859100859433, - -0.4757837756391457 - ], - "rotation_angle_deg": 0.5415889089345158, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.006671587484399055, - 0.01576754037685668, - -0.07105102773411881 - ], - "translation_xyz_cm": [ - 0.6671587484399055, - 1.5767540376856681, - -7.105102773411881 - ], - "translation_norm_m": 0.07308470394803769, - "rotation_rpy_deg_xyz": [ - -0.7110584568450742, - -0.17249413302427333, - -0.30712373967585577 - ], - "rotation_angle_deg": 0.7939390053946765, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010836576438109091, - 0.020615843004303414, - -0.06368435808527625 - ], - "translation_xyz_cm": [ - 1.0836576438109091, - 2.0615843004303414, - -6.368435808527625 - ], - "translation_norm_m": 0.0678095998838716, - "rotation_rpy_deg_xyz": [ - 0.09136385549102051, - 0.05654733688530006, - 0.00744052570261287 - ], - "rotation_angle_deg": 0.10770164907213244, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013615875090007279, - 0.040497966763347826, - -0.11343775854036052 - ], - "translation_xyz_cm": [ - 1.361587509000728, - 4.049796676334783, - -11.343775854036052 - ], - "translation_norm_m": 0.12121717052090039, - "rotation_rpy_deg_xyz": [ - -0.8833616580960963, - -0.09914187618707282, - 0.16805556405236433 - ], - "rotation_angle_deg": 0.9045120035676598, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00736619482979145, - 0.016730638992471736, - -0.05462504259441803 - ], - "translation_xyz_cm": [ - 0.736619482979145, - 1.6730638992471736, - -5.462504259441802 - ], - "translation_norm_m": 0.05760269425824495, - "rotation_rpy_deg_xyz": [ - -0.9052256170745232, - -0.025070423963748766, - 0.16596771581643197 - ], - "rotation_angle_deg": 0.9206198464696631, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0009284733465722006, - -0.015753189578568527, - -0.1673612312626484 - ], - "translation_xyz_cm": [ - -0.09284733465722006, - -1.5753189578568527, - -16.73612312626484 - ], - "translation_norm_m": 0.16810355967201676, - "rotation_rpy_deg_xyz": [ - -0.48472626411314895, - 1.7487984785294368, - -0.3329063277383538 - ], - "rotation_angle_deg": 1.843672815878291, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.002636875017407836, - 0.012077150243532508, - -0.03765022317356414 - ], - "translation_xyz_cm": [ - -0.2636875017407836, - 1.2077150243532508, - -3.7650223173564137 - ], - "translation_norm_m": 0.039627641525600193, - "rotation_rpy_deg_xyz": [ - 0.5610239631043143, - 0.4526712863097149, - 0.20451324066900395 - ], - "rotation_angle_deg": 0.7487163461569729, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.015242022563767721, - 0.021382332741016752, - -0.03442398750887586 - ], - "translation_xyz_cm": [ - 1.524202256376772, - 2.138233274101675, - -3.442398750887586 - ], - "translation_norm_m": 0.04329589266077329, - "rotation_rpy_deg_xyz": [ - 0.7428148871149202, - 1.039909949429218, - 0.19725588761355678 - ], - "rotation_angle_deg": 1.2920605188551422, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0034888756490931705, - 0.008733874404231123, - -0.027200316939892177 - ], - "translation_xyz_cm": [ - -0.34888756490931705, - 0.8733874404231123, - -2.7200316939892177 - ], - "translation_norm_m": 0.028780376249005226, - "rotation_rpy_deg_xyz": [ - -0.6731241992095818, - 2.4762575849126516, - 0.6352449197918263 - ], - "rotation_angle_deg": 2.6470410393405652, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01705657394973792, - 0.01474595544498103, - -0.007946236934208359 - ], - "translation_xyz_cm": [ - 1.7056573949737919, - 1.474595544498103, - -0.7946236934208359 - ], - "translation_norm_m": 0.02390632967025304, - "rotation_rpy_deg_xyz": [ - 0.3682900746255184, - 0.35237700505596303, - -0.010904480302770277 - ], - "rotation_angle_deg": 0.5098532251194815, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.001705204179272668, - 0.009949490298470698, - 0.008276952221896656 - ], - "translation_xyz_cm": [ - 0.1705204179272668, - 0.9949490298470698, - 0.8276952221896656 - ], - "translation_norm_m": 0.013054042154671154, - "rotation_rpy_deg_xyz": [ - -0.10051978792551795, - 1.9627003542472232, - 0.4795545560026394 - ], - "rotation_angle_deg": 2.0233381391978384, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.017823614543317934, - 0.011362388372984089, - 0.24241393220520854 - ], - "translation_xyz_cm": [ - 1.7823614543317934, - 1.136238837298409, - 24.241393220520855 - ], - "translation_norm_m": 0.24333372070495848, - "rotation_rpy_deg_xyz": [ - -0.38109746652536075, - 0.15380471696494316, - -0.2925446895040787 - ], - "rotation_angle_deg": 0.504156555873513, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.007355055466075733, - -0.00661534428014765, - 0.025440167953447043 - ], - "translation_xyz_cm": [ - 0.7355055466075733, - -0.661534428014765, - 2.5440167953447044 - ], - "translation_norm_m": 0.027295819576512566, - "rotation_rpy_deg_xyz": [ - 0.2376239793245543, - 1.6709861400327526, - 0.5217717415374492 - ], - "rotation_angle_deg": 1.7655780804705579, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.037970835799887914, - -0.005605743167969468, - 0.23191297431791189 - ], - "translation_xyz_cm": [ - 3.7970835799887914, - -0.5605743167969468, - 23.191297431791188 - ], - "translation_norm_m": 0.2350677272293833, - "rotation_rpy_deg_xyz": [ - 0.07231067521941315, - -0.05801636497751822, - -0.2466182566247777 - ], - "rotation_angle_deg": 0.26343353189672236, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.036588506292310585, - 0.010113561720901387, - 0.3393040925112272 - ], - "translation_xyz_cm": [ - 3.6588506292310585, - 1.0113561720901387, - 33.93040925112272 - ], - "translation_norm_m": 0.34142095735067635, - "rotation_rpy_deg_xyz": [ - -0.4665584089348453, - 0.7065459119111926, - -0.23291802697407604 - ], - "rotation_angle_deg": 0.8773772666502165, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009415303814078069, - 0.012039963585760649, - 0.151701492577563 - ], - "translation_xyz_cm": [ - 0.9415303814078069, - 1.203996358576065, - 15.170149257756298 - ], - "translation_norm_m": 0.15246951013011825, - "rotation_rpy_deg_xyz": [ - 0.9615693054078647, - -1.330911760658794, - -0.737661039199939 - ], - "rotation_angle_deg": 1.795419219437786, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.008663982150276528, - 0.024569060725551317, - 0.2100425702275327 - ], - "translation_xyz_cm": [ - -0.8663982150276528, - 2.4569060725551317, - 21.00425702275327 - ], - "translation_norm_m": 0.21165203670039215, - "rotation_rpy_deg_xyz": [ - 0.801629370721204, - -0.19670806726649093, - -0.689648844816506 - ], - "rotation_angle_deg": 1.0747150144675521, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003945284204720956, - -0.012542794807472557, - 0.10462850420246506 - ], - "translation_xyz_cm": [ - 0.3945284204720956, - -1.2542794807472557, - 10.462850420246506 - ], - "translation_norm_m": 0.10545146210785145, - "rotation_rpy_deg_xyz": [ - -0.6535185250266816, - 0.7244473074505394, - 0.006379181532635643 - ], - "rotation_angle_deg": 0.9757038887878208, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0025974883323312548, - -0.004205998563290514, - -0.054489048274145704 - ], - "translation_xyz_cm": [ - 0.2597488332331255, - -0.4205998563290514, - -5.44890482741457 - ], - "translation_norm_m": 0.054712829860766476, - "rotation_rpy_deg_xyz": [ - -0.43915097058719127, - 0.7740835159489979, - 0.09294873767310093 - ], - "rotation_angle_deg": 0.8951238440139575, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0013283761402047567, - 0.02659392110655978, - 0.03558707577539302 - ], - "translation_xyz_cm": [ - 0.13283761402047567, - 2.659392110655978, - 3.5587075775393022 - ], - "translation_norm_m": 0.044445935531107414, - "rotation_rpy_deg_xyz": [ - -0.7625324033102833, - 0.03417989091551074, - -0.7382415459473038 - ], - "rotation_angle_deg": 1.0617347196043798, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.016426635522518218, - -0.04079104763334751, - -0.025519128954318883 - ], - "translation_xyz_cm": [ - 1.6426635522518218, - -4.079104763334751, - -2.5519128954318884 - ], - "translation_norm_m": 0.050842598912750704, - "rotation_rpy_deg_xyz": [ - 0.1812596701200449, - 0.2554088986144745, - -0.641090634806169 - ], - "rotation_angle_deg": 0.71386476508844, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.004805226518692862, - 0.013032247429424215, - -0.005629330524235199 - ], - "translation_xyz_cm": [ - 0.4805226518692862, - 1.3032247429424215, - -0.5629330524235199 - ], - "translation_norm_m": 0.014987295857117432, - "rotation_rpy_deg_xyz": [ - -0.03272161028483042, - 0.2931935041755735, - 0.14694234528910863 - ], - "rotation_angle_deg": 0.32962060296874524, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.008293949369789111, - -0.012720082191929216, - -0.014112513574001923 - ], - "translation_xyz_cm": [ - 0.8293949369789111, - -1.2720082191929216, - -1.4112513574001921 - ], - "translation_norm_m": 0.02073048784989028, - "rotation_rpy_deg_xyz": [ - -1.295708943900491, - -0.9007950249064871, - 0.15177893077110574 - ], - "rotation_angle_deg": 1.5843617871391884, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008559326899485686, - 0.0035978233708111734, - 0.053455846601509684 - ], - "translation_xyz_cm": [ - 0.8559326899485686, - 0.35978233708111734, - 5.345584660150968 - ], - "translation_norm_m": 0.05425618808821671, - "rotation_rpy_deg_xyz": [ - -0.3156527658077964, - -0.09787576634239992, - -0.13481444661203612 - ], - "rotation_angle_deg": 0.3570208517689108, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00693339148927663, - -0.024409562400083018, - 0.0094761809563456 - ], - "translation_xyz_cm": [ - -0.693339148927663, - -2.440956240008302, - 0.9476180956345601 - ], - "translation_norm_m": 0.027086835540987935, - "rotation_rpy_deg_xyz": [ - 0.7043549696279223, - 0.10887282353005566, - -0.20645933279677145 - ], - "rotation_angle_deg": 0.7422063721688006, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0098558600400529, - 0.020852900464370272, - 0.03079341392944729 - ], - "translation_xyz_cm": [ - -0.98558600400529, - 2.085290046437027, - 3.0793413929447286 - ], - "translation_norm_m": 0.03847357244052499, - "rotation_rpy_deg_xyz": [ - 0.17545956036406737, - 1.2701659736097213, - -0.2778434467863792 - ], - "rotation_angle_deg": 1.3123950932107737, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0034456990600917337, - -0.028757253028442675, - -0.07086920076730535 - ], - "translation_xyz_cm": [ - 0.34456990600917337, - -2.8757253028442675, - -7.086920076730535 - ], - "translation_norm_m": 0.0765591017525103, - "rotation_rpy_deg_xyz": [ - 0.4853978608569899, - 0.5595428777659305, - -0.07961400153490089 - ], - "rotation_angle_deg": 0.7452604514073777, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01770255765767237, - 0.013777687611537637, - -0.14414414157362407 - ], - "translation_xyz_cm": [ - 1.7702557657672369, - 1.3777687611537637, - -14.414414157362406 - ], - "translation_norm_m": 0.14587919239405361, - "rotation_rpy_deg_xyz": [ - -0.19131281064427033, - 0.9968724123926149, - -0.032509537103797136 - ], - "rotation_angle_deg": 1.0155308493949136, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.003911924564929059, - 0.02783692104836355, - -0.13923159011951697 - ], - "translation_xyz_cm": [ - 0.3911924564929059, - 2.783692104836355, - -13.923159011951697 - ], - "translation_norm_m": 0.14204095541238695, - "rotation_rpy_deg_xyz": [ - -0.40459827562974054, - 1.2675684617373304, - 0.21015934598191227 - ], - "rotation_angle_deg": 1.3477644455082949, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017280331047126785, - 0.01910413758665841, - -0.045878140905336054 - ], - "translation_xyz_cm": [ - -1.7280331047126785, - 1.910413758665841, - -4.587814090533605 - ], - "translation_norm_m": 0.0526154133971989, - "rotation_rpy_deg_xyz": [ - 0.0370853942695332, - 0.2595280346431109, - 0.07676067119430184 - ], - "rotation_angle_deg": 0.27314725109349947, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02978974058194983, - 0.024457451410303643, - -0.07402727550482269 - ], - "translation_xyz_cm": [ - -2.978974058194983, - 2.4457451410303643, - -7.402727550482268 - ], - "translation_norm_m": 0.08346036839179512, - "rotation_rpy_deg_xyz": [ - 0.2053930322267262, - 0.9344786865517752, - 0.32436639689386765 - ], - "rotation_angle_deg": 1.0097327844707245, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008084061599809622, - 0.013247332244573418, - -0.038265444635174714 - ], - "translation_xyz_cm": [ - -0.8084061599809622, - 1.3247332244573418, - -3.8265444635174712 - ], - "translation_norm_m": 0.04129271263401391, - "rotation_rpy_deg_xyz": [ - 0.4512435396553447, - 0.7491666484307656, - 0.2511669438449359 - ], - "rotation_angle_deg": 0.909104048809833, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.010769702066319775, - 0.002834600895287309, - 0.055653372105624294 - ], - "translation_xyz_cm": [ - 1.0769702066319775, - 0.2834600895287309, - 5.565337210562429 - ], - "translation_norm_m": 0.056756667199192874, - "rotation_rpy_deg_xyz": [ - 1.2012352341832784, - 0.10475685568110953, - -0.2704645733855335 - ], - "rotation_angle_deg": 1.2359943715241535, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008101770819068488, - 0.013524540245845262, - 0.002375105343916592 - ], - "translation_xyz_cm": [ - -0.8101770819068488, - 1.3524540245845262, - 0.2375105343916592 - ], - "translation_norm_m": 0.015943431395433638, - "rotation_rpy_deg_xyz": [ - 1.0713447720263547, - 0.5121752138367888, - 0.40743318306217746 - ], - "rotation_angle_deg": 1.2538697439763702, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.023009530293275127, - 0.019415747444053277, - 0.09878139237723801 - ], - "translation_xyz_cm": [ - 2.3009530293275127, - 1.9415747444053277, - 9.8781392377238 - ], - "translation_norm_m": 0.10326748381322294, - "rotation_rpy_deg_xyz": [ - 1.906466792398904, - -0.16204206455357928, - -0.49347596562466667 - ], - "rotation_angle_deg": 1.975273654223719, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.00781348028257467, - 0.013496311873194111, - 0.018852628764943147 - ], - "translation_xyz_cm": [ - 0.781348028257467, - 1.3496311873194111, - 1.8852628764943147 - ], - "translation_norm_m": 0.024466763571291263, - "rotation_rpy_deg_xyz": [ - 1.571602249704431, - 0.6092745279339916, - 0.206158750844427 - ], - "rotation_angle_deg": 1.6971089565315203, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.01118625387650507, - 0.014321811494298231, - -3.244493679074867e-05 - ], - "translation_xyz_cm": [ - 1.118625387650507, - 1.432181149429823, - -0.003244493679074867 - ], - "translation_norm_m": 0.01817271616852475, - "rotation_rpy_deg_xyz": [ - 0.5963162220275844, - 1.1682207880887046, - -0.49627472684108254 - ], - "rotation_angle_deg": 1.4045042960916836, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.000544553715202678, - -0.01617611040469874, - 0.008366467702622664 - ], - "translation_xyz_cm": [ - 0.054455371520267803, - -1.617611040469874, - 0.8366467702622664 - ], - "translation_norm_m": 0.01821979331366775, - "rotation_rpy_deg_xyz": [ - -0.672288454569076, - -0.17518536345883584, - -0.6975466292368255 - ], - "rotation_angle_deg": 0.9852210488772688, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006672103274932617, - 0.041006888783805984, - 0.07960750826531897 - ], - "translation_xyz_cm": [ - -0.6672103274932617, - 4.100688878380598, - 7.960750826531897 - ], - "translation_norm_m": 0.08979664393534777, - "rotation_rpy_deg_xyz": [ - -1.3518977233072038, - -0.5887828415265969, - 0.6092766048205575 - ], - "rotation_angle_deg": 1.5927993601758728, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.020763472264783367, - 0.02623701734447481, - 0.06720389819137694 - ], - "translation_xyz_cm": [ - 2.0763472264783367, - 2.623701734447481, - 6.720389819137694 - ], - "translation_norm_m": 0.07507241032324496, - "rotation_rpy_deg_xyz": [ - -0.6519656961689877, - -0.26614639806366813, - 0.487341898279799 - ], - "rotation_angle_deg": 0.8555206880109816, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.010138909339030944, - -0.02398584171946594, - 0.028494499013781725 - ], - "translation_xyz_cm": [ - -1.0138909339030944, - -2.398584171946594, - 2.8494499013781724 - ], - "translation_norm_m": 0.03860122484614665, - "rotation_rpy_deg_xyz": [ - 0.6392543162624382, - -0.7595747577326487, - -0.13178306737862724 - ], - "rotation_angle_deg": 1.0009212935932472, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005366209049132653, - 0.000989232482801583, - 0.037564602408942466 - ], - "translation_xyz_cm": [ - -0.5366209049132653, - 0.0989232482801583, - 3.7564602408942465 - ], - "translation_norm_m": 0.03795884790936033, - "rotation_rpy_deg_xyz": [ - 0.3500276236705358, - -1.327354870754006, - 0.23142994607986764 - ], - "rotation_angle_deg": 1.3927737545857246, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015716096532251367, - 0.009854966100386553, - 0.03952962168282935 - ], - "translation_xyz_cm": [ - -1.5716096532251367, - 0.9854966100386553, - 3.952962168282935 - ], - "translation_norm_m": 0.04366585665526813, - "rotation_rpy_deg_xyz": [ - -1.0131171064072237, - -1.2836045800187992, - 0.16901535319157182 - ], - "rotation_angle_deg": 1.6427818388020845, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007553751863486058, - 0.02182087119397691, - -0.049227247246865946 - ], - "translation_xyz_cm": [ - 0.7553751863486058, - 2.182087119397691, - -4.922724724686595 - ], - "translation_norm_m": 0.054373996159775874, - "rotation_rpy_deg_xyz": [ - -0.5939558638522894, - -0.5117705896491087, - 0.08225849489829219 - ], - "rotation_angle_deg": 0.7880484189739134, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.006422617548786924, - 0.00492204585157574, - -0.01667839688890336 - ], - "translation_xyz_cm": [ - -0.6422617548786924, - 0.49220458515757404, - -1.667839688890336 - ], - "translation_norm_m": 0.018537677155641183, - "rotation_rpy_deg_xyz": [ - -0.11209418099713042, - -0.28929229841052456, - -0.05467203590486332 - ], - "rotation_angle_deg": 0.31507948180637074, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01000945456388247, - 0.025111856304408153, - -0.03165662387598633 - ], - "translation_xyz_cm": [ - 1.000945456388247, - 2.5111856304408153, - -3.1656623875986325 - ], - "translation_norm_m": 0.04162855201595821, - "rotation_rpy_deg_xyz": [ - 0.6855824704406601, - 0.17954563693395836, - -0.1519311487658391 - ], - "rotation_angle_deg": 0.7250301793802022, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014389040732654124, - 0.01325562687074966, - -0.03555406738412162 - ], - "translation_xyz_cm": [ - 1.4389040732654124, - 1.325562687074966, - -3.5554067384121617 - ], - "translation_norm_m": 0.04058137312237205, - "rotation_rpy_deg_xyz": [ - 0.8362842631236832, - 0.16598873535751493, - -0.08429637078407252 - ], - "rotation_angle_deg": 0.8568740377187055, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0028880117640086578, - 0.0027325280432729526, - 0.02159139874323638 - ], - "translation_xyz_cm": [ - 0.2888011764008658, - 0.27325280432729526, - 2.159139874323638 - ], - "translation_norm_m": 0.021954403229096323, - "rotation_rpy_deg_xyz": [ - 1.1090365378655247, - -0.20826684949977023, - 0.017093771980973595 - ], - "rotation_angle_deg": 1.1285817941483023, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.11849490926332651, - "improved_pairs": 27, - "worsened_pairs": 39, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.08349931538584737, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667892170896, - 0.0011901746480735614, - 0.7159624384405358 - ], - "rotation_rpy_deg_xyz": [ - -0.8880870599061297, - 1.4011794298989813, - -0.8376743139361774 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10146524807256484, - "median": 0.05629897475431494, - "p90": 0.15963531965764388, - "p95": 0.2106499295427135, - "max": 0.33630847700340843 - }, - "rotation_deg": { - "rms": 1.0646575627535269, - "median": 0.8822034197081274, - "p90": 1.6448284445376076, - "p95": 1.8365468393863742, - "max": 2.5310697757029503 - }, - "normalized_pair_score": { - "rms": 2.9414386837539155, - "median": 2.4490936386263185, - "p90": 4.663756567135647, - "p95": 4.8575105426744205, - "max": 6.886842018995678 - }, - "normalized_global_rms": 2.9414386837539155 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012347089981138093, - 0.013437463992124532, - 0.07489918672116615 - ], - "translation_xyz_cm": [ - -1.2347089981138093, - 1.3437463992124532, - 7.489918672116615 - ], - "translation_norm_m": 0.07709023440769963, - "rotation_rpy_deg_xyz": [ - -0.49293887218940247, - -0.080574625512603, - 0.025798084495368287 - ], - "rotation_angle_deg": 0.5001285987059726, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6816953294526065, - "median": 0.7204657180292057, - "p90": 2.2714964920288296, - "p95": 3.825941572676517, - "max": 5.676337113128431 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012347089981138093, - 0.013437463992124532, - 0.07489918672116615 - ], - "translation_xyz_cm": [ - -1.2347089981138093, - 1.3437463992124532, - 7.489918672116615 - ], - "translation_norm_m": 0.07709023440769963, - "rotation_rpy_deg_xyz": [ - -0.49293887218940247, - -0.080574625512603, - 0.025798084495368287 - ], - "rotation_angle_deg": 0.5001285987059726, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02118873542198385, - -0.015609536269950652, - 0.12768326261243312 - ], - "translation_xyz_cm": [ - 2.118873542198385, - -1.5609536269950652, - 12.768326261243313 - ], - "translation_norm_m": 0.13036731063691273, - "rotation_rpy_deg_xyz": [ - -0.2418540226149386, - -0.14507836952473746, - -0.34406385996642225 - ], - "rotation_angle_deg": 0.44511961856905025, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.034187422821581825, - 0.007826099760466887, - 0.10355093870014236 - ], - "translation_xyz_cm": [ - 3.4187422821581825, - 0.7826099760466887, - 10.355093870014235 - ], - "translation_norm_m": 0.10932897430380949, - "rotation_rpy_deg_xyz": [ - -0.17233618989507188, - -0.1757468117407714, - -0.3988360352824728 - ], - "rotation_angle_deg": 0.4689002568662313, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034628846199888264, - -0.018859654846083873, - 0.04540603137867161 - ], - "translation_xyz_cm": [ - 3.4628846199888264, - -1.8859654846083873, - 4.54060313786716 - ], - "translation_norm_m": 0.06013776896102682, - "rotation_rpy_deg_xyz": [ - 0.29534389433904523, - 0.10705200999236439, - -0.34998680599330545 - ], - "rotation_angle_deg": 0.4705015534970398, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04669959990172434, - 0.01140457545255602, - 0.022672297872694282 - ], - "translation_xyz_cm": [ - 4.669959990172434, - 1.140457545255602, - 2.2672297872694283 - ], - "translation_norm_m": 0.05315025929440376, - "rotation_rpy_deg_xyz": [ - 0.4422807279707848, - 0.31989023520893, - -0.38115890926659507 - ], - "rotation_angle_deg": 0.6664560850091904, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.014447777553358188, - 0.009293306322116557, - -0.0339174929407485 - ], - "translation_xyz_cm": [ - 1.4447777553358188, - 0.9293306322116557, - -3.39174929407485 - ], - "translation_norm_m": 0.03801973363943699, - "rotation_rpy_deg_xyz": [ - 0.6133830594120848, - 0.27022129610932744, - 0.13628108258484078 - ], - "rotation_angle_deg": 0.6836926995680854, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.005622716556953506, - 0.020707480418980823, - -0.010098613521045418 - ], - "translation_xyz_cm": [ - 0.5622716556953505, - 2.0707480418980824, - -1.0098613521045419 - ], - "translation_norm_m": 0.023714904212957612, - "rotation_rpy_deg_xyz": [ - 0.3017742828763355, - 0.23975635368863432, - -0.03279109359622179 - ], - "rotation_angle_deg": 0.3868686520623362, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031950423034711885, - 2.9707218591024098e-05, - -0.07152415334531535 - ], - "translation_xyz_cm": [ - -3.1950423034711886, - 0.00297072185910241, - -7.152415334531535 - ], - "translation_norm_m": 0.07833603849046791, - "rotation_rpy_deg_xyz": [ - 0.6330196157388501, - 0.5815985041822255, - 0.5367690337922438 - ], - "rotation_angle_deg": 1.0117478481643591, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.029551363096625205, - -0.01718822263609121, - -0.1295958427921709 - ], - "translation_xyz_cm": [ - -2.9551363096625205, - -1.718822263609121, - -12.95958427921709 - ], - "translation_norm_m": 0.13402910328458328, - "rotation_rpy_deg_xyz": [ - 0.7249245008303035, - 0.42208492481110155, - 0.40222197606629917 - ], - "rotation_angle_deg": 0.9291396341773344, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.0309254974468276, - -0.020363930882593334, - -0.051123472949776996 - ], - "translation_xyz_cm": [ - -3.09254974468276, - -2.0363930882593335, - -5.1123472949777 - ], - "translation_norm_m": 0.06312436581678552, - "rotation_rpy_deg_xyz": [ - 0.5301370745418749, - 0.3943207958119903, - 0.5875191260010544 - ], - "rotation_angle_deg": 0.8829294587106913, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03740999286786298, - -0.038012697412351304, - -0.07733007985358507 - ], - "translation_xyz_cm": [ - -3.740999286786298, - -3.8012697412351306, - -7.733007985358507 - ], - "translation_norm_m": 0.0939383520246038, - "rotation_rpy_deg_xyz": [ - 0.7001515462618214, - 0.854671857879406, - 0.504022002253132 - ], - "rotation_angle_deg": 1.212201864409844, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012937751111876783, - -0.010551132879353053, - -0.03065670679857446 - ], - "translation_xyz_cm": [ - -1.2937751111876783, - -1.0551132879353053, - -3.065670679857446 - ], - "translation_norm_m": 0.03490767079890028, - "rotation_rpy_deg_xyz": [ - 0.36198494354678357, - 0.3008971111901856, - -0.08634434348935659 - ], - "rotation_angle_deg": 0.47873929801643317, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.013116492319991513, - -0.0016867312735686646, - -0.21028205412466955 - ], - "translation_xyz_cm": [ - 1.3116492319991513, - -0.16867312735686646, - -21.028205412466956 - ], - "translation_norm_m": 0.210697483895893, - "rotation_rpy_deg_xyz": [ - 0.006436235120281744, - 0.19552836120838354, - 0.297135283710071 - ], - "rotation_angle_deg": 0.35574644028281466, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.011068654908585218, - 0.018271612903068654, - -0.19504725732942763 - ], - "translation_xyz_cm": [ - 1.1068654908585218, - 1.8271612903068655, - -19.504725732942763 - ], - "translation_norm_m": 0.19621365791222814, - "rotation_rpy_deg_xyz": [ - 0.12831007428301602, - -0.04952816818432277, - 0.40093327958095537 - ], - "rotation_angle_deg": 0.4239202762224175, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.005800476340794614, - 0.006752532110722798, - -0.13391767210102554 - ], - "translation_xyz_cm": [ - -0.5800476340794614, - 0.6752532110722798, - -13.391767210102554 - ], - "translation_norm_m": 0.13421320768331355, - "rotation_rpy_deg_xyz": [ - 0.5209632459620627, - -0.23227697760736274, - -0.09181993918064493 - ], - "rotation_angle_deg": 0.5775740953526642, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00874757021346606, - 0.015789094070698173, - -0.13665037853038559 - ], - "translation_xyz_cm": [ - 0.874757021346606, - 1.5789094070698173, - -13.665037853038559 - ], - "translation_norm_m": 0.13783737312032082, - "rotation_rpy_deg_xyz": [ - -0.7674964661658625, - 0.7169534998144673, - 0.29209709094510655 - ], - "rotation_angle_deg": 1.0914160684125922, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009322252065248726, - -0.002035455322972224, - -0.061678986542036775 - ], - "translation_xyz_cm": [ - -0.9322252065248726, - -0.2035455322972224, - -6.167898654203677 - ], - "translation_norm_m": 0.062412697768904395, - "rotation_rpy_deg_xyz": [ - -0.6924385999054452, - 0.2964601447283968, - -0.2105873829744931 - ], - "rotation_angle_deg": 0.7816333365963862, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.00828351536698424, - -0.01982484580969306, - 0.07050334608340655 - ], - "translation_xyz_cm": [ - -0.828351536698424, - -1.982484580969306, - 7.0503346083406555 - ], - "translation_norm_m": 0.07370456530751515, - "rotation_rpy_deg_xyz": [ - 0.3336184622861757, - -0.3215902388066507, - -0.48238156632580986 - ], - "rotation_angle_deg": 0.6682130633061891, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0019609408434754227, - -0.002374756254913346, - 0.0015605147353553485 - ], - "translation_xyz_cm": [ - 0.19609408434754227, - -0.2374756254913346, - 0.15605147353553483 - ], - "translation_norm_m": 0.0034525298696928513, - "rotation_rpy_deg_xyz": [ - 0.22621184482600595, - -0.23249026314661073, - -0.4764680283668011 - ], - "rotation_angle_deg": 0.5760271473832896, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.005660030864195809, - 0.015107478111636263, - -0.06975284769804696 - ], - "translation_xyz_cm": [ - 0.5660030864195809, - 1.5107478111636263, - -6.975284769804696 - ], - "translation_norm_m": 0.0715942148938317, - "rotation_rpy_deg_xyz": [ - -0.6624475601491372, - -0.256836904281241, - -0.30630523736315207 - ], - "rotation_angle_deg": 0.7742948445496051, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010562141009244186, - 0.020449264255443245, - -0.06297604004403039 - ], - "translation_xyz_cm": [ - 1.0562141009244186, - 2.0449264255443245, - -6.297604004403039 - ], - "translation_norm_m": 0.06705007718799007, - "rotation_rpy_deg_xyz": [ - 0.09439266660044536, - 0.03354128418620416, - 0.007100577041866337 - ], - "rotation_angle_deg": 0.10042419437572178, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013078460162727623, - 0.040134113374020286, - -0.11195194961771592 - ], - "translation_xyz_cm": [ - 1.3078460162727623, - 4.013411337402029, - -11.195194961771591 - ], - "translation_norm_m": 0.11964544370662164, - "rotation_rpy_deg_xyz": [ - -0.8697482458371678, - -0.1480768269894866, - 0.16833582974942987 - ], - "rotation_angle_deg": 0.8979678963314063, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0070261610932721985, - 0.016578369201178056, - -0.0536110360803175 - ], - "translation_xyz_cm": [ - 0.7026161093272199, - 1.6578369201178056, - -5.36110360803175 - ], - "translation_norm_m": 0.05655397823923872, - "rotation_rpy_deg_xyz": [ - -0.9009000989928097, - -0.05273910636938967, - 0.16605654654750157 - ], - "rotation_angle_deg": 0.9175177645063037, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.001497311734963036, - -0.016245448732132406, - -0.16583106924192764 - ], - "translation_xyz_cm": [ - -0.1497311734963036, - -1.6245448732132406, - -16.583106924192766 - ], - "translation_norm_m": 0.1666316298691848, - "rotation_rpy_deg_xyz": [ - -0.4638025026288426, - 1.689027122739734, - -0.3328786727258601 - ], - "rotation_angle_deg": 1.7816167127074216, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0030703770143927778, - 0.01191466732277624, - -0.036330058452113574 - ], - "translation_xyz_cm": [ - -0.3070377014392778, - 1.191466732277624, - -3.6330058452113576 - ], - "translation_norm_m": 0.03835700274470012, - "rotation_rpy_deg_xyz": [ - 0.5676729977317706, - 0.4182398444691579, - 0.20377287449153683 - ], - "rotation_angle_deg": 0.733385458597603, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01445737723000562, - 0.020991635875972525, - -0.03366317384792669 - ], - "translation_xyz_cm": [ - 1.445737723000562, - 2.0991635875972525, - -3.3663173847926693 - ], - "translation_norm_m": 0.04222409035889154, - "rotation_rpy_deg_xyz": [ - 0.7684470216245958, - 0.9744843093631123, - 0.19594853938341622 - ], - "rotation_angle_deg": 1.2553683111312608, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.004543772580525296, - 0.006867913981144724, - -0.024795033696255273 - ], - "translation_xyz_cm": [ - -0.4543772580525296, - 0.6867913981144724, - -2.4795033696255273 - ], - "translation_norm_m": 0.02612676420290831, - "rotation_rpy_deg_xyz": [ - -0.5268495314151538, - 2.389014362807181, - 0.6383057437678961 - ], - "rotation_angle_deg": 2.5310697757029503, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016605686918671037, - 0.014634267833917414, - -0.007476559861917781 - ], - "translation_xyz_cm": [ - 1.6605686918671037, - 1.4634267833917414, - -0.7476559861917781 - ], - "translation_norm_m": 0.023362567933439857, - "rotation_rpy_deg_xyz": [ - 0.3754170287071176, - 0.31672915302275556, - -0.011545276101289782 - ], - "rotation_angle_deg": 0.4913371503622357, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.0004399575749562956, - 0.008482939299369052, - 0.010756026242157105 - ], - "translation_xyz_cm": [ - 0.04399575749562956, - 0.8482939299369052, - 1.0756026242157106 - ], - "translation_norm_m": 0.013705689415221463, - "rotation_rpy_deg_xyz": [ - 0.01220749222764503, - 1.8649473919358657, - 0.48078516425100726 - ], - "rotation_angle_deg": 1.9259077626308265, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01663326833912615, - 0.009012638890500746, - 0.2407889043120313 - ], - "translation_xyz_cm": [ - 1.663326833912615, - 0.9012638890500746, - 24.078890431203128 - ], - "translation_norm_m": 0.24153092910681337, - "rotation_rpy_deg_xyz": [ - -0.21425576961871212, - 0.08089860617375802, - -0.2892807018342832 - ], - "rotation_angle_deg": 0.36884388586889244, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.006087028993551735, - -0.007605179098087167, - 0.027577839116066365 - ], - "translation_xyz_cm": [ - 0.6087028993551735, - -0.7605179098087167, - 2.7577839116066363 - ], - "translation_norm_m": 0.029247698736720493, - "rotation_rpy_deg_xyz": [ - 0.3140120502856556, - 1.57525066499022, - 0.521611056847392 - ], - "rotation_angle_deg": 1.6874741778014157, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03646730914906715, - -0.007429735397891157, - 0.23012825721424696 - ], - "translation_xyz_cm": [ - 3.646730914906715, - -0.7429735397891157, - 23.012825721424697 - ], - "translation_norm_m": 0.23311816826048312, - "rotation_rpy_deg_xyz": [ - 0.20815453553090077, - -0.1499324297124423, - -0.2450266819100822 - ], - "rotation_angle_deg": 0.35455962473243163, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0353946151254545, - 0.00755212162933816, - 0.3343554671055473 - ], - "translation_xyz_cm": [ - 3.53946151254545, - 0.755212162933816, - 33.43554671055473 - ], - "translation_norm_m": 0.33630847700340843, - "rotation_rpy_deg_xyz": [ - -0.2940406543266296, - 0.6391386974303508, - -0.2293572694264693 - ], - "rotation_angle_deg": 0.7394654002831409, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.008506349264195467, - 0.012071434400522385, - 0.15192297291192308 - ], - "translation_xyz_cm": [ - 0.8506349264195467, - 1.2071434400522385, - 15.192297291192308 - ], - "translation_norm_m": 0.15263900944610295, - "rotation_rpy_deg_xyz": [ - 0.9801872068156441, - -1.3875182444294034, - -0.7390935702146647 - ], - "rotation_angle_deg": 1.8478642641547214, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010146738762454977, - 0.02420968941446633, - 0.2088641756576748 - ], - "translation_xyz_cm": [ - -1.0146738762454977, - 2.420968941446633, - 20.88641756576748 - ], - "translation_norm_m": 0.210507266483175, - "rotation_rpy_deg_xyz": [ - 0.8530897983719065, - -0.28268257421163223, - -0.6910403064367562 - ], - "rotation_angle_deg": 1.1323818010676363, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003327303388096947, - -0.012524195423037066, - 0.10515503746900104 - ], - "translation_xyz_cm": [ - 0.3327303388096947, - -1.2524195423037066, - 10.515503746900103 - ], - "translation_norm_m": 0.10595049940390973, - "rotation_rpy_deg_xyz": [ - -0.6431789619561372, - 0.6816002120134335, - 0.006415269287748453 - ], - "rotation_angle_deg": 0.937199758755503, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0017243954807127926, - -0.004640655024457985, - -0.05173335082370843 - ], - "translation_xyz_cm": [ - 0.17243954807127926, - -0.4640655024457985, - -5.173335082370843 - ], - "translation_norm_m": 0.05196969122747242, - "rotation_rpy_deg_xyz": [ - -0.4088325476548906, - 0.7038008988485257, - 0.09305929523078052 - ], - "rotation_angle_deg": 0.8195150284001523, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006348178668695859, - 0.026375044741966835, - 0.035191925623644565 - ], - "translation_xyz_cm": [ - 0.06348178668695859, - 2.6375044741966835, - 3.5191925623644567 - ], - "translation_norm_m": 0.04398315141011363, - "rotation_rpy_deg_xyz": [ - -0.7445818153138412, - -0.021545785806351456, - -0.7379821838797836 - ], - "rotation_angle_deg": 1.048657693866843, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015383567676146015, - -0.04136243647205484, - -0.020541912482167614 - ], - "translation_xyz_cm": [ - 1.5383567676146015, - -4.136243647205484, - -2.0541912482167612 - ], - "translation_norm_m": 0.048677258281217634, - "rotation_rpy_deg_xyz": [ - 0.21928945158048752, - 0.17836678087840258, - -0.6416915735795427 - ], - "rotation_angle_deg": 0.7015039811043354, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.003808325700971338, - 0.01263494614920968, - -0.00015754658593369886 - ], - "translation_xyz_cm": [ - 0.3808325700971338, - 1.263494614920968, - -0.015754658593369886 - ], - "translation_norm_m": 0.013197349346169734, - "rotation_rpy_deg_xyz": [ - -0.004072229166585534, - 0.224568771694988, - 0.14654123170934782 - ], - "rotation_angle_deg": 0.2681871739641515, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.007504162260566716, - -0.012880044259107992, - -0.011040319717752878 - ], - "translation_xyz_cm": [ - 0.7504162260566716, - -1.2880044259107992, - -1.1040319717752878 - ], - "translation_norm_m": 0.018549842339483574, - "rotation_rpy_deg_xyz": [ - -1.2798054310636306, - -0.9534785736787509, - 0.15248962768500685 - ], - "rotation_angle_deg": 1.6021827112737996, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.007168244893041464, - 0.00265880474117218, - 0.05579366903420734 - ], - "translation_xyz_cm": [ - 0.7168244893041464, - 0.265880474117218, - 5.579366903420734 - ], - "translation_norm_m": 0.05631506443037211, - "rotation_rpy_deg_xyz": [ - -0.23978605413750892, - -0.19347954393461095, - -0.1340614928944615 - ], - "rotation_angle_deg": 0.33617350319494377, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.007287610351404794, - -0.027009093420932828, - 0.011489255684468389 - ], - "translation_xyz_cm": [ - -0.7287610351404794, - -2.700909342093283, - 1.148925568446839 - ], - "translation_norm_m": 0.030242410423735547, - "rotation_rpy_deg_xyz": [ - 0.9015192205847944, - 0.08681840489389321, - -0.20230751191186624 - ], - "rotation_angle_deg": 0.9281584039245215, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.01079135854162816, - 0.02054147625377567, - 0.03313881297825094 - ], - "translation_xyz_cm": [ - -1.079135854162816, - 2.054147625377567, - 3.313881297825094 - ], - "translation_norm_m": 0.04045474745275138, - "rotation_rpy_deg_xyz": [ - 0.20362339466301457, - 1.2020283837049592, - -0.2784957801004705 - ], - "rotation_angle_deg": 1.2510315251871484, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0021671074909486165, - -0.030166267803071856, - -0.06516361851235676 - ], - "translation_xyz_cm": [ - 0.21671074909486165, - -3.0166267803071856, - -6.5163618512356765 - ], - "translation_norm_m": 0.07184008105276567, - "rotation_rpy_deg_xyz": [ - 0.5875558825335884, - 0.4609998337939518, - -0.07965236006563277 - ], - "rotation_angle_deg": 0.7513067688769995, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01721721379744956, - 0.011384625529307524, - -0.13572474011000724 - ], - "translation_xyz_cm": [ - 1.721721379744956, - 1.1384625529307524, - -13.572474011000724 - ], - "translation_norm_m": 0.13728527680461097, - "rotation_rpy_deg_xyz": [ - 0.0014385057544094495, - 0.9608870177011732, - -0.0283275126393505 - ], - "rotation_angle_deg": 0.9613059047947397, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0040731705009897645, - 0.025431030850569414, - -0.1324031842245602 - ], - "translation_xyz_cm": [ - 0.40731705009897645, - 2.5431030850569414, - -13.24031842245602 - ], - "translation_norm_m": 0.1348848814391575, - "rotation_rpy_deg_xyz": [ - -0.20583895354216938, - 1.2849377578940078, - 0.21520913687321333 - ], - "rotation_angle_deg": 1.3193708258832553, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018385526298199117, - 0.01826169598266003, - -0.04379710129184038 - ], - "translation_xyz_cm": [ - -1.8385526298199117, - 1.8261695982660031, - -4.379710129184038 - ], - "translation_norm_m": 0.050889126530061404, - "rotation_rpy_deg_xyz": [ - 0.0989893684579667, - 0.1685083813025341, - 0.076675795329284 - ], - "rotation_angle_deg": 0.20988285259820716, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.030906095118024668, - 0.022998466202759915, - -0.07281837328519915 - ], - "translation_xyz_cm": [ - -3.090609511802467, - 2.2998466202759915, - -7.281837328519915 - ], - "translation_norm_m": 0.08238101511286737, - "rotation_rpy_deg_xyz": [ - 0.3205919517214839, - 0.8370724366221942, - 0.32514089474038266 - ], - "rotation_angle_deg": 0.9527115011977059, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008726078752184119, - 0.013005432959144692, - -0.03714192705931947 - ], - "translation_xyz_cm": [ - -0.8726078752184119, - 1.3005432959144692, - -3.7141927059319473 - ], - "translation_norm_m": 0.04030891318956558, - "rotation_rpy_deg_xyz": [ - 0.46638929712082594, - 0.697681800664475, - 0.2502820426655999 - ], - "rotation_angle_deg": 0.8749255828077164, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.009685542120729362, - 0.0008827123197421294, - 0.05543621781399344 - ], - "translation_xyz_cm": [ - 0.9685542120729362, - 0.08827123197421294, - 5.543621781399343 - ], - "translation_norm_m": 0.056282885078257766, - "rotation_rpy_deg_xyz": [ - 1.3553268091951465, - 0.022066309180181258, - -0.26989496897840287 - ], - "rotation_angle_deg": 1.3821644021573776, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008844482773376239, - 0.011053973041791343, - 0.007354166882595423 - ], - "translation_xyz_cm": [ - -0.8844482773376239, - 1.1053973041791343, - 0.7354166882595423 - ], - "translation_norm_m": 0.015953023728254842, - "rotation_rpy_deg_xyz": [ - 1.2547601548553928, - 0.45842643245173226, - 0.4099478198257644 - ], - "rotation_angle_deg": 1.3958880373798794, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.021818341330403612, - 0.018341314563928623, - 0.09427138558629748 - ], - "translation_xyz_cm": [ - 2.1818341330403612, - 1.8341314563928623, - 9.427138558629748 - ], - "translation_norm_m": 0.09848623243227124, - "rotation_rpy_deg_xyz": [ - 2.009310398275689, - -0.2605375172351304, - -0.49594138674450494 - ], - "rotation_angle_deg": 2.0848505994534294, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.006617947587249429, - 0.01150842180576217, - 0.02309886555985438 - ], - "translation_xyz_cm": [ - 0.6617947587249429, - 1.150842180576217, - 2.3098865559854382 - ], - "translation_norm_m": 0.026642045583609934, - "rotation_rpy_deg_xyz": [ - 1.7144970743354413, - 0.5203669519130223, - 0.20564783478568635 - ], - "rotation_angle_deg": 1.8025945650813329, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.010389900803214225, - 0.01186529925041957, - 0.005157642711380445 - ], - "translation_xyz_cm": [ - 1.0389900803214225, - 1.186529925041957, - 0.5157642711380445 - ], - "translation_norm_m": 0.01659327102595792, - "rotation_rpy_deg_xyz": [ - 0.7780451720476518, - 1.1119722028903116, - -0.4934269812295707 - ], - "rotation_angle_deg": 1.446626076312717, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00013541352996382372, - -0.01630250960364027, - 0.009961527995296336 - ], - "translation_xyz_cm": [ - -0.013541352996382372, - -1.630250960364027, - 0.9961527995296336 - ], - "translation_norm_m": 0.019105554066866346, - "rotation_rpy_deg_xyz": [ - -0.6587100415852261, - -0.2240605217853735, - -0.6974471968403082 - ], - "rotation_angle_deg": 0.9860652541035315, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005849281708567133, - 0.040908087814580885, - 0.07434636638866111 - ], - "translation_xyz_cm": [ - -0.5849281708567133, - 4.0908087814580885, - 7.434636638866111 - ], - "translation_norm_m": 0.08505920256120839, - "rotation_rpy_deg_xyz": [ - -1.3398312390714697, - -0.5396725690969726, - 0.6092220708196656 - ], - "rotation_angle_deg": 1.5651915149277613, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02230550916359597, - 0.025454992230004247, - 0.058547214195144484 - ], - "translation_xyz_cm": [ - 2.230550916359597, - 2.5454992230004247, - 5.854721419514449 - ], - "translation_norm_m": 0.067625946636546, - "rotation_rpy_deg_xyz": [ - -0.5807631684274817, - -0.1689183508787147, - 0.48962883170125776 - ], - "rotation_angle_deg": 0.7776341358424744, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.009152091818644292, - -0.02425709020102007, - 0.025787620419585038 - ], - "translation_xyz_cm": [ - -0.9152091818644292, - -2.425709020102007, - 2.5787620419585036 - ], - "translation_norm_m": 0.0365673156873993, - "rotation_rpy_deg_xyz": [ - 0.6672611144715639, - -0.6886985763938718, - -0.12912803272967815 - ], - "rotation_angle_deg": 0.9670448538198824, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004447584719295072, - 0.0008059892753259912, - 0.034794669467049 - ], - "translation_xyz_cm": [ - -0.44475847192950724, - 0.08059892753259912, - 3.4794669467048998 - ], - "translation_norm_m": 0.03508702968147118, - "rotation_rpy_deg_xyz": [ - 0.370927435300329, - -1.2646592186187953, - 0.23336378744872377 - ], - "rotation_angle_deg": 1.3391457676861183, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.014249037057554315, - 0.008662881437794479, - 0.0349599743036387 - ], - "translation_xyz_cm": [ - -1.4249037057554315, - 0.8662881437794479, - 3.4959974303638703 - ], - "translation_norm_m": 0.03873345292100768, - "rotation_rpy_deg_xyz": [ - -0.9170060314783413, - -1.1822125088192947, - 0.17131903518479694 - ], - "rotation_angle_deg": 1.5048600109564099, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.008614508719718694, - 0.019976290643349826, - -0.04879854946916989 - ], - "translation_xyz_cm": [ - 0.8614508719718694, - 1.9976290643349826, - -4.879854946916988 - ], - "translation_norm_m": 0.05342808604699139, - "rotation_rpy_deg_xyz": [ - -0.4455557744195208, - -0.42287976781743497, - 0.08653660683152153 - ], - "rotation_angle_deg": 0.6201211840474964, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005403245834918913, - 0.004513380846663084, - -0.019276798958956162 - ], - "translation_xyz_cm": [ - -0.5403245834918913, - 0.4513380846663084, - -1.9276798958956163 - ], - "translation_norm_m": 0.020522198964136547, - "rotation_rpy_deg_xyz": [ - -0.07745802070064917, - -0.21214323499402324, - -0.05268933571760255 - ], - "rotation_angle_deg": 0.23193913826709664, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011161792026584738, - 0.023990901806485665, - -0.029854056343239385 - ], - "translation_xyz_cm": [ - 1.1161792026584738, - 2.3990901806485665, - -2.9854056343239384 - ], - "translation_norm_m": 0.0398925262534034, - "rotation_rpy_deg_xyz": [ - 0.7688722686685902, - 0.27950412142835496, - -0.14698837379113427 - ], - "rotation_angle_deg": 0.8315302043695855, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01500049579445717, - 0.01300916101456362, - -0.034641158214888126 - ], - "translation_xyz_cm": [ - 1.500049579445717, - 1.300916101456362, - -3.4641158214888126 - ], - "translation_norm_m": 0.039928222936305095, - "rotation_rpy_deg_xyz": [ - 0.8499761719689687, - 0.21793753771724264, - -0.08234610894610755 - ], - "rotation_angle_deg": 0.8814773807055635, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003450550833809407, - 0.00265469106567362, - 0.021022561212256635 - ], - "translation_xyz_cm": [ - 0.3450550833809407, - 0.265469106567362, - 2.1022561212256634 - ], - "translation_norm_m": 0.02146862281642554, - "rotation_rpy_deg_xyz": [ - 1.118088512545101, - -0.16522211706214945, - 0.018857373815566788 - ], - "rotation_angle_deg": 1.1304139916357179, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.08579729231126754, - "improved_pairs": 30, - "worsened_pairs": 36, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.04173782588453678, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667883966867, - -0.00132483596826191, - 0.7159622034133878 - ], - "rotation_rpy_deg_xyz": [ - -0.6880496073495588, - 1.404096019030304, - -0.8334758829122912 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.09931755660454081, - "median": 0.05421174388785016, - "p90": 0.15834627204447646, - "p95": 0.21095584207103596, - "max": 0.32611866509936216 - }, - "rotation_deg": { - "rms": 1.0760678191977628, - "median": 0.8776463592710988, - "p90": 1.674292492252943, - "p95": 1.903695315626283, - "max": 2.3194277090275017 - }, - "normalized_pair_score": { - "rms": 2.928699135454269, - "median": 2.440458245810097, - "p90": 4.658985742447703, - "p95": 4.853862528082904, - "max": 6.61569142350004 - }, - "normalized_global_rms": 2.928699135454269 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.013017932115307884, - 0.0136179450092212, - 0.07629687402453278 - ], - "translation_xyz_cm": [ - -1.3017932115307884, - 1.36179450092212, - 7.629687402453278 - ], - "translation_norm_m": 0.07858834499306092, - "rotation_rpy_deg_xyz": [ - -0.48699228692645413, - -0.12615705006128158, - 0.02570652600223137 - ], - "rotation_angle_deg": 0.5036965847149959, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.648644705864238, - "median": 0.7384894986865091, - "p90": 2.2872153823956474, - "p95": 3.7684382589726937, - "max": 5.483696631022495 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.013017932115307884, - 0.0136179450092212, - 0.07629687402453278 - ], - "translation_xyz_cm": [ - -1.3017932115307884, - 1.36179450092212, - 7.629687402453278 - ], - "translation_norm_m": 0.07858834499306092, - "rotation_rpy_deg_xyz": [ - -0.48699228692645413, - -0.12615705006128158, - 0.02570652600223137 - ], - "rotation_angle_deg": 0.5036965847149959, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.01983834457668665, - -0.015504585040189589, - 0.12936397253632068 - ], - "translation_xyz_cm": [ - 1.983834457668665, - -1.550458504018959, - 12.936397253632068 - ], - "translation_norm_m": 0.13179146202690734, - "rotation_rpy_deg_xyz": [ - -0.21985692641757718, - -0.2334013181664172, - -0.3443842361043236 - ], - "rotation_angle_deg": 0.4708734484159498, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03215841779482376, - 0.007488070882689879, - 0.1057559036558589 - ], - "translation_xyz_cm": [ - 3.2158417794823757, - 0.7488070882689879, - 10.575590365585889 - ], - "translation_norm_m": 0.11079055103517599, - "rotation_rpy_deg_xyz": [ - -0.1196467469432824, - -0.3081513953342554, - -0.39902968033958963 - ], - "rotation_angle_deg": 0.5184145137643963, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03400237854132815, - -0.018784816978978658, - 0.046298391215537554 - ], - "translation_xyz_cm": [ - 3.400237854132815, - -1.8784816978978658, - 4.629839121553755 - ], - "translation_norm_m": 0.06043651317331653, - "rotation_rpy_deg_xyz": [ - 0.3012130442605803, - 0.06178117795259717, - -0.3507014983915448 - ], - "rotation_angle_deg": 0.4665311935417798, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.045387311899497074, - 0.011216149960456168, - 0.02420263231449835 - ], - "translation_xyz_cm": [ - 4.538731189949708, - 1.1216149960456168, - 2.420263231449835 - ], - "translation_norm_m": 0.05264577392676899, - "rotation_rpy_deg_xyz": [ - 0.4679653148711452, - 0.22470055626566388, - -0.38259543754061653 - ], - "rotation_angle_deg": 0.6454161610213566, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.012279578964766696, - 0.008072698124777178, - -0.03246976371089197 - ], - "translation_xyz_cm": [ - 1.2279578964766698, - 0.8072698124777178, - -3.246976371089197 - ], - "translation_norm_m": 0.035640455524682604, - "rotation_rpy_deg_xyz": [ - 0.7090248588392039, - 0.10248398460935348, - 0.13438006756457746 - ], - "rotation_angle_deg": 0.7287704900989723, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.004938222482159602, - 0.020608270342872242, - -0.00938929003357111 - ], - "translation_xyz_cm": [ - 0.4938222482159602, - 2.0608270342872244, - -0.9389290033571109 - ], - "translation_norm_m": 0.023178559384541823, - "rotation_rpy_deg_xyz": [ - 0.3097577051373673, - 0.18664432425832636, - -0.0336095959146478 - ], - "rotation_angle_deg": 0.36324835841970443, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03361905395620376, - -0.0008442053845835185, - -0.07070275645747724 - ], - "translation_xyz_cm": [ - -3.3619053956203757, - -0.08442053845835185, - -7.070275645747724 - ], - "translation_norm_m": 0.07829325157589791, - "rotation_rpy_deg_xyz": [ - 0.6926766766182315, - 0.4419749339111483, - 0.5346941291820502 - ], - "rotation_angle_deg": 0.9788648264335834, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03162414796137569, - -0.01871719701435337, - -0.1283035384953676 - ], - "translation_xyz_cm": [ - -3.1624147961375693, - -1.871719701435337, - -12.83035384953676 - ], - "translation_norm_m": 0.13346242238468992, - "rotation_rpy_deg_xyz": [ - 0.8365623086373095, - 0.24553898238035454, - 0.4001215786438502 - ], - "rotation_angle_deg": 0.9585324964450912, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.032077029714107724, - -0.02084166332882062, - -0.050810448250677244 - ], - "translation_xyz_cm": [ - -3.2077029714107725, - -2.084166332882062, - -5.081044825067725 - ], - "translation_norm_m": 0.06360041208220593, - "rotation_rpy_deg_xyz": [ - 0.5569339845376506, - 0.2971777537677473, - 0.585917552916602 - ], - "rotation_angle_deg": 0.8602864470229568, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03910985906791155, - -0.03902144042569072, - -0.07637093944039589 - ], - "translation_xyz_cm": [ - -3.9109859067911548, - -3.9021440425690725, - -7.637093944039589 - ], - "translation_norm_m": 0.09425908062471355, - "rotation_rpy_deg_xyz": [ - 0.7672078626242982, - 0.7081141457067361, - 0.5017716188488857 - ], - "rotation_angle_deg": 1.1563027790195821, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013724739555608233, - -0.010750937945598393, - -0.02985952111748592 - ], - "translation_xyz_cm": [ - -1.3724739555608232, - -1.0750937945598393, - -2.985952111748592 - ], - "translation_norm_m": 0.03457661267309122, - "rotation_rpy_deg_xyz": [ - 0.37305631861552224, - 0.23811704847639364, - -0.08733946804193757 - ], - "rotation_angle_deg": 0.45125835251701374, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011488634223095318, - -0.0037719489798593714, - -0.21151485674058076 - ], - "translation_xyz_cm": [ - 1.1488634223095318, - -0.37719489798593714, - -21.151485674058076 - ], - "translation_norm_m": 0.21186021556065487, - "rotation_rpy_deg_xyz": [ - 0.1580646158298921, - 0.004332965408601208, - 0.29794391414239924 - ], - "rotation_angle_deg": 0.33729831825279, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.009638384220401752, - 0.01673416076358522, - -0.1968428272719935 - ], - "translation_xyz_cm": [ - 0.9638384220401752, - 1.6734160763585222, - -19.68428272719935 - ], - "translation_norm_m": 0.19778783894687124, - "rotation_rpy_deg_xyz": [ - 0.22133147920542845, - -0.21564006830911459, - 0.4004193809937665 - ], - "rotation_angle_deg": 0.5061196006354263, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.00786025470157814, - 0.004322519574601946, - -0.1319292494888606 - ], - "translation_xyz_cm": [ - -0.786025470157814, - 0.4322519574601946, - -13.19292494888606 - ], - "translation_norm_m": 0.13223386347732763, - "rotation_rpy_deg_xyz": [ - 0.7087159338677353, - -0.429042151428882, - -0.0920401992615858 - ], - "rotation_angle_deg": 0.8332681971854976, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00791305279474841, - 0.015117736796860126, - -0.1357388985434119 - ], - "translation_xyz_cm": [ - 0.791305279474841, - 1.5117736796860126, - -13.57388985434119 - ], - "translation_norm_m": 0.13680720356827078, - "rotation_rpy_deg_xyz": [ - -0.748602099535282, - 0.6349659743700895, - 0.29251668240313095 - ], - "rotation_angle_deg": 1.0254617730161373, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.01120853564457891, - -0.0031993310567137723, - -0.057692160908431704 - ], - "translation_xyz_cm": [ - -1.120853564457891, - -0.3199331056713772, - -5.76921609084317 - ], - "translation_norm_m": 0.05885790024109444, - "rotation_rpy_deg_xyz": [ - -0.6101713860139643, - 0.13766847519553718, - -0.20895219104054746 - ], - "rotation_angle_deg": 0.6592539646140351, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.009666304643551005, - -0.019963527340618875, - 0.0723557213531634 - ], - "translation_xyz_cm": [ - -0.9666304643551005, - -1.9963527340618876, - 7.23557213531634 - ], - "translation_norm_m": 0.07567912712153992, - "rotation_rpy_deg_xyz": [ - 0.35981425224376196, - -0.41765907660964374, - -0.48364320941570316 - ], - "rotation_angle_deg": 0.7324924851119249, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00021083493920937002, - -0.0030697368627858324, - 0.0038741462073057023 - ], - "translation_xyz_cm": [ - 0.021083493920937002, - -0.30697368627858324, - 0.3874146207305702 - ], - "translation_norm_m": 0.004947397761845997, - "rotation_rpy_deg_xyz": [ - 0.2798948098075749, - -0.36595893877722646, - -0.4775790372102809 - ], - "rotation_angle_deg": 0.6629430619017354, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.003631146857606571, - 0.013790956316668823, - -0.06716235566992257 - ], - "translation_xyz_cm": [ - 0.3631146857606571, - 1.3790956316668823, - -6.716235566992257 - ], - "translation_norm_m": 0.06865972416754201, - "rotation_rpy_deg_xyz": [ - -0.5652401616439944, - -0.42552542414788325, - -0.3044376927882022 - ], - "rotation_angle_deg": 0.7710551210252471, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010012345431286707, - 0.020119739369975687, - -0.06155909243799722 - ], - "translation_xyz_cm": [ - 1.0012345431286707, - 2.0119739369975687, - -6.155909243799722 - ], - "translation_norm_m": 0.06553299043337671, - "rotation_rpy_deg_xyz": [ - 0.10044818017110235, - -0.012472718023224458, - 0.0065376810065954525 - ], - "rotation_angle_deg": 0.10143120709710246, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011999672212322343, - 0.03941316734725264, - -0.10898097531392557 - ], - "translation_xyz_cm": [ - 1.1999672212322343, - 3.9413167347252642, - -10.898097531392557 - ], - "translation_norm_m": 0.1165085527930039, - "rotation_rpy_deg_xyz": [ - -0.8425283336628414, - -0.24594667650555593, - 0.16911866942622683 - ], - "rotation_angle_deg": 0.8934940390715803, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0063445205389954795, - 0.016278939380289903, - -0.05158305071915964 - ], - "translation_xyz_cm": [ - 0.634452053899548, - 1.6278939380289903, - -5.158305071915964 - ], - "translation_norm_m": 0.05446161886789893, - "rotation_rpy_deg_xyz": [ - -0.8922524435409469, - -0.10807630768911798, - 0.1663730997139781 - ], - "rotation_angle_deg": 0.91388954617272, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.002639858200167433, - -0.017223605793230234, - -0.16277183952612045 - ], - "translation_xyz_cm": [ - -0.2639858200167433, - -1.7223605793230234, - -16.277183952612045 - ], - "translation_norm_m": 0.16370184235540752, - "rotation_rpy_deg_xyz": [ - -0.4219546296413655, - 1.5694825037371833, - -0.332574303248646 - ], - "rotation_angle_deg": 1.6577286006431422, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.003939894753068052, - 0.01159620225658653, - -0.03369017215768068 - ], - "translation_xyz_cm": [ - -0.39398947530680517, - 1.159620225658653, - -3.369017215768068 - ], - "translation_norm_m": 0.035847208781927195, - "rotation_rpy_deg_xyz": [ - 0.5809697215906171, - 0.34937282941870285, - 0.20246088889661396 - ], - "rotation_angle_deg": 0.7070069620582611, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.012885381454306621, - 0.020213324587171844, - -0.032144417792908886 - ], - "translation_xyz_cm": [ - 1.2885381454306621, - 2.0213324587171844, - -3.2144417792908886 - ], - "translation_norm_m": 0.040098318435246534, - "rotation_rpy_deg_xyz": [ - 0.819712559149489, - 0.8436253477040967, - 0.1935904856231919 - ], - "rotation_angle_deg": 1.191116992875964, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.006664911601660606, - 0.0031301732303883334, - -0.0200035023689703 - ], - "translation_xyz_cm": [ - -0.6664911601660606, - 0.31301732303883334, - -2.00035023689703 - ], - "translation_norm_m": 0.021315701680582565, - "rotation_rpy_deg_xyz": [ - -0.234332046117054, - 2.214504521790122, - 0.6442262182453095 - ], - "rotation_angle_deg": 2.3194277090275017, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015702995125691066, - 0.014413236617246916, - -0.006537976024776855 - ], - "translation_xyz_cm": [ - 1.5702995125691066, - 1.4413236617246916, - -0.6537976024776855 - ], - "translation_norm_m": 0.02229507964109529, - "rotation_rpy_deg_xyz": [ - 0.3896690398585717, - 0.24542977439821137, - -0.012653036793608265 - ], - "rotation_angle_deg": 0.4607154448821106, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.002103537913360487, - 0.005548280524320548, - 0.015699228387622267 - ], - "translation_xyz_cm": [ - -0.2103537913360487, - 0.5548280524320548, - 1.5699228387622266 - ], - "translation_norm_m": 0.016783148110417916, - "rotation_rpy_deg_xyz": [ - 0.23764307206691626, - 1.669428150172129, - 0.48318928967281216 - ], - "rotation_angle_deg": 1.753159980102663, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01425933302998783, - 0.00431887674250353, - 0.23751511274611473 - ], - "translation_xyz_cm": [ - 1.425933302998783, - 0.431887674250353, - 23.751511274611474 - ], - "translation_norm_m": 0.23798195321825694, - "rotation_rpy_deg_xyz": [ - 0.11940686784989951, - -0.0649432779613318, - -0.28299549226361076 - ], - "rotation_angle_deg": 0.3138849105795759, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0035399890072618234, - -0.00958210140124699, - 0.031842941692668734 - ], - "translation_xyz_cm": [ - 0.35399890072618234, - -0.958210140124699, - 3.1842941692668734 - ], - "translation_norm_m": 0.03344130866276042, - "rotation_rpy_deg_xyz": [ - 0.4667815105795986, - 1.3837710520905426, - 0.5214136240856849 - ], - "rotation_angle_deg": 1.5487659772153461, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03346921358318955, - -0.01107419703564938, - 0.22653923535239004 - ], - "translation_xyz_cm": [ - 3.346921358318955, - -1.107419703564938, - 22.653923535239002 - ], - "translation_norm_m": 0.22926589639958905, - "rotation_rpy_deg_xyz": [ - 0.4798249841779736, - -0.33378257655495847, - -0.24200606018272505 - ], - "rotation_angle_deg": 0.6320855365331995, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03302500441886491, - 0.0024480583808834666, - 0.3244329511925194 - ], - "translation_xyz_cm": [ - 3.302500441886491, - 0.24480583808834666, - 32.44329511925194 - ], - "translation_norm_m": 0.32611866509936216, - "rotation_rpy_deg_xyz": [ - 0.05097218713694677, - 0.5042919230940032, - -0.22247898864767532 - ], - "rotation_angle_deg": 0.5536288288411338, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006687846004071352, - 0.012135619913909323, - 0.1523619186741018 - ], - "translation_xyz_cm": [ - 0.6687846004071352, - 1.2135619913909323, - 15.236191867410179 - ], - "translation_norm_m": 0.1529907017335454, - "rotation_rpy_deg_xyz": [ - 1.017414852445509, - -1.5007391101032885, - -0.741716175060454 - ], - "rotation_angle_deg": 1.953873760800823, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013106862460808166, - 0.023488267446107436, - 0.20649828703671194 - ], - "translation_xyz_cm": [ - -1.3106862460808166, - 2.3488267446107436, - 20.649828703671194 - ], - "translation_norm_m": 0.20824272160217916, - "rotation_rpy_deg_xyz": [ - 0.9560058968720943, - -0.45464073045523223, - -0.6936011235526104 - ], - "rotation_angle_deg": 1.2635062040532659, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002090127704166278, - -0.012484495166692033, - 0.10620593932795044 - ], - "translation_xyz_cm": [ - 0.2090127704166278, - -1.2484495166692033, - 10.620593932795044 - ], - "translation_norm_m": 0.10695762152328918, - "rotation_rpy_deg_xyz": [ - -0.6225024149839725, - 0.5959053156587848, - 0.006689322250610905 - ], - "rotation_angle_deg": 0.8617986794706172, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -3.2157678040878324e-05, - -0.005499872216122359, - -0.046225606869712874 - ], - "translation_xyz_cm": [ - -0.0032157678040878324, - -0.5499872216122359, - -4.622560686971287 - ], - "translation_norm_m": 0.04655165259132244, - "rotation_rpy_deg_xyz": [ - -0.3482010749585525, - 0.5632329830802514, - 0.09353902827139053 - ], - "rotation_angle_deg": 0.6689873194782009, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0007511322684967681, - 0.02593564448339669, - 0.0343994103711647 - ], - "translation_xyz_cm": [ - -0.0751132268496768, - 2.593564448339669, - 3.43994103711647 - ], - "translation_norm_m": 0.0430876001691637, - "rotation_rpy_deg_xyz": [ - -0.7086879115057579, - -0.13299771174088573, - -0.7372227758705762 - ], - "rotation_angle_deg": 1.031808960510595, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013277145349635422, - -0.04248866777442739, - -0.01059231484054184 - ], - "translation_xyz_cm": [ - 1.3277145349635422, - -4.248866777442739, - -1.0592314840541839 - ], - "translation_norm_m": 0.04575769456126667, - "rotation_rpy_deg_xyz": [ - 0.2953432993096583, - 0.024276594342236574, - -0.642640752760065 - ], - "rotation_angle_deg": 0.7077313416720086, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.001794393297110286, - 0.011860863916217657, - 0.010781973120621735 - ], - "translation_xyz_cm": [ - 0.1794393297110286, - 1.1860863916217657, - 1.0781973120621735 - ], - "translation_norm_m": 0.016129193548270103, - "rotation_rpy_deg_xyz": [ - 0.05322103816012282, - 0.0873148989234108, - 0.14599742270015667 - ], - "rotation_angle_deg": 0.1782127115159501, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.005915857270801794, - -0.013186374289907932, - -0.004898498461515383 - ], - "translation_xyz_cm": [ - 0.5915857270801794, - -1.3186374289907932, - -0.48984984615153826 - ], - "translation_norm_m": 0.015260180907823863, - "rotation_rpy_deg_xyz": [ - -1.2480103106897278, - -1.058843996491766, - 0.15414421877221693 - ], - "rotation_angle_deg": 1.642814571668502, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.004374287039567326, - 0.0007838937654551098, - 0.0604585256615161 - ], - "translation_xyz_cm": [ - 0.4374287039567326, - 0.07838937654551098, - 6.04585256615161 - ], - "translation_norm_m": 0.06062163146686376, - "rotation_rpy_deg_xyz": [ - -0.08806771004129846, - -0.3846944983171834, - -0.1324291932841721 - ], - "rotation_angle_deg": 0.41636699811798167, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.007997996819602449, - -0.032217990788736495, - 0.015488778343847528 - ], - "translation_xyz_cm": [ - -0.7997996819602449, - -3.2217990788736497, - 1.548877834384753 - ], - "translation_norm_m": 0.03663153202057376, - "rotation_rpy_deg_xyz": [ - 1.2958400450806427, - 0.04266646215682582, - -0.1941017916906235 - ], - "rotation_angle_deg": 1.3110617730447771, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012670868387613554, - 0.01992757793276212, - 0.037825590104856865 - ], - "translation_xyz_cm": [ - -1.2670868387613554, - 1.992757793276212, - 3.7825590104856865 - ], - "translation_norm_m": 0.044591866239743524, - "rotation_rpy_deg_xyz": [ - 0.2599509179968717, - 1.0657478885400091, - -0.27954207491021793 - ], - "rotation_angle_deg": 1.1326447576219019, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0004199725898179629, - -0.03298459317517233, - -0.053765968998156596 - ], - "translation_xyz_cm": [ - -0.04199725898179629, - -3.2984593175172328, - -5.3765968998156595 - ], - "translation_norm_m": 0.0630788331076167, - "rotation_rpy_deg_xyz": [ - 0.7918610937070613, - 0.2639023368677551, - -0.07973284213892447 - ], - "rotation_angle_deg": 0.8386509098504318, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.016230180908550107, - 0.00655784058089548, - -0.11891122281659616 - ], - "translation_xyz_cm": [ - 1.6230180908550107, - 0.655784058089548, - -11.891122281659616 - ], - "translation_norm_m": 0.12019277414697975, - "rotation_rpy_deg_xyz": [ - 0.38692637644802275, - 0.8888747430593863, - -0.02012409085729838 - ], - "rotation_angle_deg": 0.9697077369388957, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.00440160186338967, - 0.020584168597544306, - -0.11877208815026812 - ], - "translation_xyz_cm": [ - 0.44016018633896703, - 2.0584168597544306, - -11.877208815026812 - ], - "translation_norm_m": 0.1206229290781441, - "rotation_rpy_deg_xyz": [ - 0.1916882068648239, - 1.319628086391854, - 0.2254135487757883 - ], - "rotation_angle_deg": 1.3520261902008246, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.020605994652241666, - 0.016581126614279462, - -0.03964270443966929 - ], - "translation_xyz_cm": [ - -2.0605994652241666, - 1.6581126614279462, - -3.964270443966929 - ], - "translation_norm_m": 0.0476558998519381, - "rotation_rpy_deg_xyz": [ - 0.22278781569591202, - -0.013537867412669194, - 0.07669208081428176 - ], - "rotation_angle_deg": 0.23601565492143653, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.033145084106716016, - 0.020079745497173396, - -0.07041504316578547 - ], - "translation_xyz_cm": [ - -3.3145084106716016, - 2.0079745497173396, - -7.041504316578546 - ], - "translation_norm_m": 0.08037456739362249, - "rotation_rpy_deg_xyz": [ - 0.5509740610289262, - 0.6422465045093532, - 0.32662070486861217 - ], - "rotation_angle_deg": 0.9059314169765579, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010013261615174407, - 0.012526696010335514, - -0.034896567845720705 - ], - "translation_xyz_cm": [ - -1.0013261615174407, - 1.2526696010335514, - -3.4896567845720705 - ], - "translation_norm_m": 0.038405129455845725, - "rotation_rpy_deg_xyz": [ - 0.4966800732158183, - 0.5947067685194851, - 0.248742067360889 - ], - "rotation_angle_deg": 0.812990987051528, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.007518281622342471, - -0.0030199598314828435, - 0.05498157598284424 - ], - "translation_xyz_cm": [ - 0.7518281622342471, - -0.30199598314828435, - 5.498157598284424 - ], - "translation_norm_m": 0.05557533997641308, - "rotation_rpy_deg_xyz": [ - 1.6634984243109143, - -0.14333359187958822, - -0.2689789923828324 - ], - "rotation_angle_deg": 1.6908563838627437, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.010343954282202361, - 0.006091474608785008, - 0.017287273250941357 - ], - "translation_xyz_cm": [ - -1.0343954282202361, - 0.6091474608785008, - 1.7287273250941357 - ], - "translation_norm_m": 0.021046455035337367, - "rotation_rpy_deg_xyz": [ - 1.6215760807623987, - 0.35089750032929207, - 0.4147554148577664 - ], - "rotation_angle_deg": 1.7089531595917278, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.01945950005563235, - 0.016193541920977772, - 0.08523839699328972 - ], - "translation_xyz_cm": [ - 1.945950005563235, - 1.6193541920977772, - 8.523839699328972 - ], - "translation_norm_m": 0.08891843039745631, - "rotation_rpy_deg_xyz": [ - 2.214999368144162, - -0.4575397243207946, - -0.5008798467259478 - ], - "rotation_angle_deg": 2.314633272255785, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004206689245159989, - 0.007523653449277745, - 0.03157185146675964 - ], - "translation_xyz_cm": [ - 0.4206689245159989, - 0.7523653449277745, - 3.1571851466759644 - ], - "translation_norm_m": 0.03272741054023839, - "rotation_rpy_deg_xyz": [ - 2.0002777012985367, - 0.3425368948038387, - 0.20443638646340861 - ], - "rotation_angle_deg": 2.039062434787097, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008781302678148695, - 0.006930614080590702, - 0.015512996253103276 - ], - "translation_xyz_cm": [ - 0.8781302678148695, - 0.6930614080590702, - 1.5512996253103275 - ], - "translation_norm_m": 0.01912583961576955, - "rotation_rpy_deg_xyz": [ - 1.14148402182609, - 0.9994427669670941, - -0.4879592132363607 - ], - "rotation_angle_deg": 1.5967607472864411, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0014994559028700394, - -0.01654796174426343, - 0.013149610887739083 - ], - "translation_xyz_cm": [ - -0.14994559028700394, - -1.6547961744263429, - 1.3149610887739083 - ], - "translation_norm_m": 0.021189517983975094, - "rotation_rpy_deg_xyz": [ - -0.6315599512326644, - -0.3218116038887659, - -0.6970262115921333 - ], - "rotation_angle_deg": 0.9953599910223782, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0042164880377972835, - 0.04068600076668827, - 0.06382172697406434 - ], - "translation_xyz_cm": [ - -0.42164880377972835, - 4.068600076668827, - 6.382172697406434 - ], - "translation_norm_m": 0.07580463220484522, - "rotation_rpy_deg_xyz": [ - -1.3156911465186127, - -0.44145388009391223, - 0.6088879086073773 - ], - "rotation_angle_deg": 1.513429918568732, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.025346406474271, - 0.023877560196617686, - 0.0412226284208161 - ], - "translation_xyz_cm": [ - 2.5346406474271, - 2.3877560196617686, - 4.12226284208161 - ], - "translation_norm_m": 0.0539618689078014, - "rotation_rpy_deg_xyz": [ - -0.4383357914399517, - 0.025533281150201273, - 0.4940616729484009 - ], - "rotation_angle_deg": 0.661046491067773, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0071882621904129085, - -0.024809734875171907, - 0.020369392135433186 - ], - "translation_xyz_cm": [ - -0.7188262190412908, - -2.4809734875171907, - 2.0369392135433184 - ], - "translation_norm_m": 0.03289538256140956, - "rotation_rpy_deg_xyz": [ - 0.7232951016153538, - -0.54693962393305, - -0.12408306725311925 - ], - "rotation_angle_deg": 0.9147864986566497, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0026191289076589186, - 0.00042793997181950205, - 0.02925121531401631 - ], - "translation_xyz_cm": [ - -0.26191289076589186, - 0.042793997181950205, - 2.925121531401631 - ], - "translation_norm_m": 0.029371356219986808, - "rotation_rpy_deg_xyz": [ - 0.41274562167094014, - -1.139262541141826, - 0.2369732815309715 - ], - "rotation_angle_deg": 1.2354641040164327, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01133854338900031, - 0.006277729035329971, - 0.025806871515065652 - ], - "translation_xyz_cm": [ - -1.133854338900031, - 0.6277729035329971, - 2.5806871515065652 - ], - "translation_norm_m": 0.028878487935146024, - "rotation_rpy_deg_xyz": [ - -0.7247604553303281, - -0.9794384570991861, - 0.17591307498083045 - ], - "rotation_angle_deg": 1.2301745445583785, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010738525195524207, - 0.016286270208435982, - -0.04796054080269111 - ], - "translation_xyz_cm": [ - 1.0738525195524207, - 1.6286270208435982, - -4.796054080269111 - ], - "translation_norm_m": 0.05177617207522874, - "rotation_rpy_deg_xyz": [ - -0.14872751926920416, - -0.24512552901504017, - 0.09532935805965427 - ], - "rotation_angle_deg": 0.30204863242621327, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0033747558477470463, - 0.0036871762667178842, - -0.024478586432092192 - ], - "translation_xyz_cm": [ - -0.33747558477470463, - 0.3687176266717884, - -2.4478586432092193 - ], - "translation_norm_m": 0.024983703479811766, - "rotation_rpy_deg_xyz": [ - -0.008168726135522247, - -0.057842414825320244, - -0.04898525449319768 - ], - "rotation_angle_deg": 0.07623930710928334, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.013476039869520395, - 0.02175086923545755, - -0.026259497268802584 - ], - "translation_xyz_cm": [ - 1.3476039869520395, - 2.175086923545755, - -2.6259497268802585 - ], - "translation_norm_m": 0.03666422179554787, - "rotation_rpy_deg_xyz": [ - 0.93548800376033, - 0.4794160617907114, - -0.13718381498058635 - ], - "rotation_angle_deg": 1.0605966008102643, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.016225851507391198, - 0.012520378792477582, - -0.03281680750957035 - ], - "translation_xyz_cm": [ - 1.6225851507391198, - 1.2520378792477582, - -3.281680750957035 - ], - "translation_norm_m": 0.03869083867490112, - "rotation_rpy_deg_xyz": [ - 0.8773698405174778, - 0.3218421256722765, - -0.07867923811740489 - ], - "rotation_angle_deg": 0.9380491523300574, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004574405722232999, - 0.0024963085108008487, - 0.01988339752452991 - ], - "translation_xyz_cm": [ - 0.4574405722232999, - 0.24963085108008487, - 1.9883397524529909 - ], - "translation_norm_m": 0.020554956604458618, - "rotation_rpy_deg_xyz": [ - 1.1362015598108992, - -0.0791255451490655, - 0.02218031439651488 - ], - "rotation_angle_deg": 1.1391845260639735, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.07305774401162113, - "improved_pairs": 29, - "worsened_pairs": 37, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.028170056427377133, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.301514381728528, - 0.0024476764333135038, - 0.7136887808759609 - ], - "rotation_rpy_deg_xyz": [ - -0.98957173596909, - 1.4997049033829544, - -0.8398067936647792 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.102893833307342, - "median": 0.058647822415504244, - "p90": 0.1612773573681593, - "p95": 0.20899250501296773, - "max": 0.34102879485003584 - }, - "rotation_deg": { - "rms": 1.1155635852142416, - "median": 0.9032016705641412, - "p90": 1.7237961721609267, - "p95": 1.8523188479157913, - "max": 2.7649230606587203 - }, - "normalized_pair_score": { - "rms": 3.035256961724302, - "median": 2.567240614380259, - "p90": 4.665150885339164, - "p95": 4.867844831646721, - "max": 7.1030716468727 - }, - "normalized_global_rms": 3.035256961724302 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01208464163388967, - 0.013039256664958754, - 0.07327791948984122 - ], - "translation_xyz_cm": [ - -1.208464163388967, - 1.3039256664958754, - 7.327791948984122 - ], - "translation_norm_m": 0.07540367539154748, - "rotation_rpy_deg_xyz": [ - -0.473130282285162, - -0.05481315085147722, - 0.026504623063242874 - ], - "rotation_angle_deg": 0.47701910095086286, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7135991876939975, - "median": 0.7501993496833461, - "p90": 2.4068068761684835, - "p95": 3.7744794821981595, - "max": 5.799621427831512 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01208464163388967, - 0.013039256664958754, - 0.07327791948984122 - ], - "translation_xyz_cm": [ - -1.208464163388967, - 1.3039256664958754, - 7.327791948984122 - ], - "translation_norm_m": 0.07540367539154748, - "rotation_rpy_deg_xyz": [ - -0.473130282285162, - -0.05481315085147722, - 0.026504623063242874 - ], - "rotation_angle_deg": 0.47701910095086286, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021856702474127743, - -0.01628389507877359, - 0.12457968141647374 - ], - "translation_xyz_cm": [ - 2.1856702474127743, - -1.6283895078773591, - 12.457968141647374 - ], - "translation_norm_m": 0.12752638042306833, - "rotation_rpy_deg_xyz": [ - -0.20871087549424475, - -0.08992908671513256, - -0.34253766498908095 - ], - "rotation_angle_deg": 0.4112074527490782, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.035418549287047574, - 0.007048460250196342, - 0.09992321493663883 - ], - "translation_xyz_cm": [ - 3.5418549287047574, - 0.7048460250196342, - 9.992321493663884 - ], - "translation_norm_m": 0.10624878026956987, - "rotation_rpy_deg_xyz": [ - -0.1325116884956509, - -0.08321580241890679, - -0.3965573320358145 - ], - "rotation_angle_deg": 0.4264014012649048, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03492113210345826, - -0.01917063699226018, - 0.043686431140914604 - ], - "translation_xyz_cm": [ - 3.4921132103458263, - -1.9170636992260182, - 4.36864311409146 - ], - "translation_norm_m": 0.05912277950084951, - "rotation_rpy_deg_xyz": [ - 0.31504066977001116, - 0.13261028984895482, - -0.3489329964018299 - ], - "rotation_angle_deg": 0.48871706557315686, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.047455720349456776, - 0.010896347048949373, - 0.020434654121718302 - ], - "translation_xyz_cm": [ - 4.745572034945678, - 1.0896347048949373, - 2.0434654121718303 - ], - "translation_norm_m": 0.05280483748645812, - "rotation_rpy_deg_xyz": [ - 0.47703065368728603, - 0.3803013815445009, - -0.3788042681618934 - ], - "rotation_angle_deg": 0.7189417739675726, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.016150586430554087, - 0.008889638740942285, - -0.03651277811010629 - ], - "translation_xyz_cm": [ - 1.6150586430554088, - 0.8889638740942285, - -3.6512778110106288 - ], - "translation_norm_m": 0.0409029349107508, - "rotation_rpy_deg_xyz": [ - 0.6494190209484018, - 0.40185303550142704, - 0.14080163513652716 - ], - "rotation_angle_deg": 0.776152485822299, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.006009442582104266, - 0.02042712987058473, - -0.01057252059667046 - ], - "translation_xyz_cm": [ - 0.6009442582104266, - 2.042712987058473, - -1.057252059667046 - ], - "translation_norm_m": 0.023773077770124006, - "rotation_rpy_deg_xyz": [ - 0.32433561928513177, - 0.27029118428046195, - -0.03155254579717572 - ], - "rotation_angle_deg": 0.42343188185652425, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.030687010660929437, - -0.00034129043824709937, - -0.07245287795032951 - ], - "translation_xyz_cm": [ - -3.0687010660929435, - -0.03412904382470994, - -7.245287795032951 - ], - "translation_norm_m": 0.07868436074438541, - "rotation_rpy_deg_xyz": [ - 0.6730124459047927, - 0.6811965056320695, - 0.5405490692126742 - ], - "rotation_angle_deg": 1.0976476543806457, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.027761910937621648, - -0.0174170140068286, - -0.13108813018387538 - ], - "translation_xyz_cm": [ - -2.776191093762165, - -1.7417014006828602, - -13.108813018387538 - ], - "translation_norm_m": 0.13512281062399184, - "rotation_rpy_deg_xyz": [ - 0.7573773307817553, - 0.5661111304691714, - 0.4072673593732334 - ], - "rotation_angle_deg": 1.0280626502325205, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03011089405543875, - -0.02068414696155768, - -0.05164464762054739 - ], - "translation_xyz_cm": [ - -3.011089405543875, - -2.0684146961557683, - -5.164464762054739 - ], - "translation_norm_m": 0.06325875041601504, - "rotation_rpy_deg_xyz": [ - 0.5653109891689735, - 0.4562630231205246, - 0.590017108953984 - ], - "rotation_angle_deg": 0.934457166253611, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03606793570157982, - -0.03832958223109706, - -0.0784315437487233 - ], - "translation_xyz_cm": [ - -3.606793570157982, - -3.832958223109706, - -7.84315437487233 - ], - "translation_norm_m": 0.09445400952099188, - "rotation_rpy_deg_xyz": [ - 0.7399277947464856, - 0.9614365712140539, - 0.5081204355372686 - ], - "rotation_angle_deg": 1.3129007580472671, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012451944260278694, - -0.010832645884559428, - -0.03111707421378177 - ], - "translation_xyz_cm": [ - -1.2451944260278693, - -1.0832645884559429, - -3.1117074213781772 - ], - "translation_norm_m": 0.03522313785492928, - "rotation_rpy_deg_xyz": [ - 0.3878371998164776, - 0.3378071270643779, - -0.08484330931531564 - ], - "rotation_angle_deg": 0.5214626131111922, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.014979582998971841, - -0.0014581379812270284, - -0.2099519041142579 - ], - "translation_xyz_cm": [ - 1.497958299897184, - -0.14581379812270284, - -20.99519041142579 - ], - "translation_norm_m": 0.21049065564627312, - "rotation_rpy_deg_xyz": [ - 0.026182168028126344, - 0.3669141538032287, - 0.3004922661181984 - ], - "rotation_angle_deg": 0.4749277935294012, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.012574119833949626, - 0.018319141728629126, - -0.1946798900896417 - ], - "translation_xyz_cm": [ - 1.2574119833949626, - 1.8319141728629127, - -19.46798900896417 - ], - "translation_norm_m": 0.19594376501585117, - "rotation_rpy_deg_xyz": [ - 0.16481731887534973, - 0.080005673042547, - 0.40431193924169234 - ], - "rotation_angle_deg": 0.4437799078166375, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0035778829227025577, - 0.006987533039174598, - -0.13532239125067366 - ], - "translation_xyz_cm": [ - -0.35778829227025577, - 0.6987533039174598, - -13.532239125067367 - ], - "translation_norm_m": 0.13554990386563365, - "rotation_rpy_deg_xyz": [ - 0.5253922517195333, - -0.04008234859107405, - -0.08680218438530024 - ], - "rotation_angle_deg": 0.5339908835455367, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.009524985065067382, - 0.01572459484953015, - -0.1400006389503744 - ], - "translation_xyz_cm": [ - 0.9524985065067382, - 1.572459484953015, - -14.00006389503744 - ], - "translation_norm_m": 0.14120257480012435, - "rotation_rpy_deg_xyz": [ - -0.7359504803280884, - 0.7673934748040167, - 0.2930603344317491 - ], - "rotation_angle_deg": 1.10420937508025, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.007775667058880276, - -0.0023443733761543406, - -0.06542895893233319 - ], - "translation_xyz_cm": [ - -0.7775667058880276, - -0.23443733761543406, - -6.542895893233319 - ], - "translation_norm_m": 0.06593106818265816, - "rotation_rpy_deg_xyz": [ - -0.6541965223785923, - 0.41699294917611507, - -0.2090607218091834 - ], - "rotation_angle_deg": 0.8028478455370961, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.007587093923854482, - -0.02044922878035134, - 0.07123664624184298 - ], - "translation_xyz_cm": [ - -0.7587093923854482, - -2.044922878035134, - 7.123664624184298 - ], - "translation_norm_m": 0.0745009712668635, - "rotation_rpy_deg_xyz": [ - 0.3685325018616431, - -0.26048854632734314, - -0.4801211656789722 - ], - "rotation_angle_deg": 0.6583167608108, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.003144810627101813, - -0.002873007677882622, - 0.0010175579397699516 - ], - "translation_xyz_cm": [ - 0.3144810627101813, - -0.2873007677882622, - 0.10175579397699516 - ], - "translation_norm_m": 0.004379432743894335, - "rotation_rpy_deg_xyz": [ - 0.26607166429433904, - -0.1389489700924768, - -0.4735234266883899 - ], - "rotation_angle_deg": 0.5603742424401951, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.007344547647743782, - 0.014800805685669771, - -0.07178242199737835 - ], - "translation_xyz_cm": [ - 0.7344547647743782, - 1.4800805685669771, - -7.178242199737834 - ], - "translation_norm_m": 0.07365950269248794, - "rotation_rpy_deg_xyz": [ - -0.626753686598787, - -0.12387646512787955, - -0.30471851047637966 - ], - "rotation_angle_deg": 0.7081177402078626, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.011007466859051462, - 0.020372772560280694, - -0.06448972101567134 - ], - "translation_xyz_cm": [ - 1.1007466859051462, - 2.0372772560280694, - -6.448972101567134 - ], - "translation_norm_m": 0.06852107927583426, - "rotation_rpy_deg_xyz": [ - 0.11436566790442429, - 0.0595661259045448, - 0.008080262815954344 - ], - "rotation_angle_deg": 0.12919736092408854, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014025449169186355, - 0.04000169778763918, - -0.11536481266956945 - ], - "translation_xyz_cm": [ - 1.4025449169186355, - 4.000169778763918, - -11.536481266956946 - ], - "translation_norm_m": 0.12290601715366054, - "rotation_rpy_deg_xyz": [ - -0.8344446994448821, - -0.08552564233068592, - 0.16932447128424916 - ], - "rotation_angle_deg": 0.8556119565077912, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007538925567035004, - 0.016416196137580608, - -0.0555422360593153 - ], - "translation_xyz_cm": [ - 0.7538925567035004, - 1.6416196137580608, - -5.554223605931529 - ], - "translation_norm_m": 0.05840605174809812, - "rotation_rpy_deg_xyz": [ - -0.8775660451684503, - -0.020744209052822916, - 0.1666750795183922 - ], - "rotation_angle_deg": 0.8934649176086595, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.00048299696699083405, - -0.016297124384176964, - -0.17174414804376578 - ], - "translation_xyz_cm": [ - -0.048299696699083405, - -1.6297124384176964, - -17.17441480437658 - ], - "translation_norm_m": 0.17251632368139078, - "rotation_rpy_deg_xyz": [ - -0.42492381204305896, - 1.7697138959260355, - -0.3311983829210027 - ], - "rotation_angle_deg": 1.8487210197879693, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.002492684371473819, - 0.011693925454111964, - -0.038763265674629066 - ], - "translation_xyz_cm": [ - -0.2492684371473819, - 1.1693925454111964, - -3.8763265674629066 - ], - "translation_norm_m": 0.040565405626765194, - "rotation_rpy_deg_xyz": [ - 0.5954604225262117, - 0.4593022994732532, - 0.2055663008986702 - ], - "rotation_angle_deg": 0.7789771903942916, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.015626273658449596, - 0.020721536863292034, - -0.0384440439231334 - ], - "translation_xyz_cm": [ - 1.5626273658449596, - 2.0721536863292034, - -3.84440439231334 - ], - "translation_norm_m": 0.04638434037031611, - "rotation_rpy_deg_xyz": [ - 0.808274481683889, - 1.065510960047381, - 0.19970118939018527 - ], - "rotation_angle_deg": 1.3511030374499777, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0017396743235238432, - 0.007664245055356567, - -0.03266203468531201 - ], - "translation_xyz_cm": [ - -0.17396743235238432, - 0.7664245055356567, - -3.266203468531201 - ], - "translation_norm_m": 0.03359427970361934, - "rotation_rpy_deg_xyz": [ - -0.5857915030951795, - 2.622431757211252, - 0.638371590113869 - ], - "rotation_angle_deg": 2.7649230606587203, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.017203514975057566, - 0.014371987950761111, - -0.010862531228842204 - ], - "translation_xyz_cm": [ - 1.7203514975057566, - 1.4371987950761111, - -1.0862531228842203 - ], - "translation_norm_m": 0.024910029101777954, - "rotation_rpy_deg_xyz": [ - 0.4039385970423517, - 0.3594868397373558, - -0.009831538600971306 - ], - "rotation_angle_deg": 0.5408495339506397, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.0030950451100084653, - 0.008719863351088764, - 0.0045604298959720825 - ], - "translation_xyz_cm": [ - 0.3095045110008465, - 0.8719863351088764, - 0.45604298959720824 - ], - "translation_norm_m": 0.010315660033692668, - "rotation_rpy_deg_xyz": [ - -0.0026784990993738585, - 2.075367149021988, - 0.4838730038602838 - ], - "rotation_angle_deg": 2.131035055200222, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.020252172115300504, - 0.010169324313240136, - 0.2389636062532431 - ], - "translation_xyz_cm": [ - 2.0252172115300504, - 1.0169324313240136, - 23.89636062532431 - ], - "translation_norm_m": 0.2400357697217867, - "rotation_rpy_deg_xyz": [ - -0.3082428961375435, - 0.3206606437176471, - -0.28882514093282485 - ], - "rotation_angle_deg": 0.5298659945657888, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.008299099435876034, - -0.007884001977133348, - 0.025404712682173446 - ], - "translation_xyz_cm": [ - 0.8299099435876034, - -0.7884001977133348, - 2.5404712682173445 - ], - "translation_norm_m": 0.027864528797124578, - "rotation_rpy_deg_xyz": [ - 0.3334328702890166, - 1.7473310495028265, - 0.5258940929215999 - ], - "rotation_angle_deg": 1.8535181239583984, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03984200721196962, - -0.00712810781373352, - 0.23065673457958652 - ], - "translation_xyz_cm": [ - 3.984200721196962, - -0.712810781373352, - 23.065673457958653 - ], - "translation_norm_m": 0.23418096563683538, - "rotation_rpy_deg_xyz": [ - 0.1641500556785251, - 0.07780319475820995, - -0.24166897865671275 - ], - "rotation_angle_deg": 0.30241740823885727, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03917801071856508, - 0.008855978791005636, - 0.3386551255077311 - ], - "translation_xyz_cm": [ - 3.917801071856508, - 0.8855978791005636, - 33.86551255077311 - ], - "translation_norm_m": 0.34102879485003584, - "rotation_rpy_deg_xyz": [ - -0.3991665864557057, - 0.87905100009278, - -0.2295393071242416 - ], - "rotation_angle_deg": 0.9916364320984434, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009561740227491233, - 0.011277676007708903, - 0.14761815712580492 - ], - "translation_xyz_cm": [ - 0.9561740227491233, - 1.1277676007708903, - 14.761815712580493 - ], - "translation_norm_m": 0.14835677660805288, - "rotation_rpy_deg_xyz": [ - 1.0181261161106774, - -1.3123816697221933, - -0.7355869202838428 - ], - "rotation_angle_deg": 1.8118435457432893, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.008088805193718684, - 0.023264369787523442, - 0.203009344750324 - ], - "translation_xyz_cm": [ - -0.8088805193718684, - 2.3264369787523442, - 20.3009344750324 - ], - "translation_norm_m": 0.2044980531130516, - "rotation_rpy_deg_xyz": [ - 0.887566585877532, - -0.14533213100229525, - -0.6858279933398516 - ], - "rotation_angle_deg": 1.1303547233182998, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003954129149073449, - -0.013136717487908678, - 0.10141390847297119 - ], - "translation_xyz_cm": [ - 0.39541291490734487, - -1.3136717487908678, - 10.141390847297119 - ], - "translation_norm_m": 0.10233762414405005, - "rotation_rpy_deg_xyz": [ - -0.6106711811726857, - 0.7347834263458103, - 0.007527646916360982 - ], - "rotation_angle_deg": 0.9554770959694707, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00304853775731162, - -0.0050153289375689525, - -0.058596391242643896 - ], - "translation_xyz_cm": [ - 0.304853775731162, - -0.5015328937568952, - -5.8596391242643895 - ], - "translation_norm_m": 0.05888959308291038, - "rotation_rpy_deg_xyz": [ - -0.3688660467445685, - 0.8043913294891651, - 0.09503641346957155 - ], - "rotation_angle_deg": 0.89029727263952, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0016804106310628342, - 0.02591094633204416, - 0.029396194841183637 - ], - "translation_xyz_cm": [ - 0.16804106310628342, - 2.591094633204416, - 2.9396194841183636 - ], - "translation_norm_m": 0.03922164186838554, - "rotation_rpy_deg_xyz": [ - -0.7068245594514829, - 0.05213052697737454, - -0.7367520989439647 - ], - "rotation_angle_deg": 1.0220770230000462, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.016897010180928707, - -0.04174580360786151, - -0.02482748536383033 - ], - "translation_xyz_cm": [ - 1.6897010180928707, - -4.174580360786151, - -2.482748536383033 - ], - "translation_norm_m": 0.051425918576256474, - "rotation_rpy_deg_xyz": [ - 0.2582868039923888, - 0.2934043998667456, - -0.6383395241878062 - ], - "rotation_angle_deg": 0.7490781928989391, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.005092433669120933, - 0.012109811185325503, - -0.003770840993212371 - ], - "translation_xyz_cm": [ - 0.5092433669120933, - 1.2109811185325503, - -0.3770840993212371 - ], - "translation_norm_m": 0.013667466825082181, - "rotation_rpy_deg_xyz": [ - 0.03589061737159056, - 0.32182041291819696, - 0.1491736438789013 - ], - "rotation_angle_deg": 0.3564816347029057, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.008234102130471044, - -0.013345577581940993, - -0.007720757103971659 - ], - "translation_xyz_cm": [ - 0.8234102130471044, - -1.3345577581940993, - -0.7720757103971659 - ], - "translation_norm_m": 0.017478986502345112, - "rotation_rpy_deg_xyz": [ - -1.2430584362087147, - -0.8848678460711231, - 0.15303406598245656 - ], - "rotation_angle_deg": 1.5325256343686569, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.009451617117289146, - 0.002270733148463905, - 0.05425283677765851 - ], - "translation_xyz_cm": [ - 0.9451617117289146, - 0.22707331484639048, - 5.425283677765851 - ], - "translation_norm_m": 0.0551167814153423, - "rotation_rpy_deg_xyz": [ - -0.22009894992399132, - -0.022018695375128777, - -0.13144135220319145 - ], - "rotation_angle_deg": 0.2573252718256102, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0042823969684397944, - -0.024556983229219342, - 0.0042816766353913766 - ], - "translation_xyz_cm": [ - -0.42823969684397944, - -2.4556983229219345, - 0.42816766353913766 - ], - "translation_norm_m": 0.025292629438742005, - "rotation_rpy_deg_xyz": [ - 0.7262857895340283, - 0.3059867820063376, - -0.20004009381057433 - ], - "rotation_angle_deg": 0.8135779073549219, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.009585249532476858, - 0.020020120210054948, - 0.025649193253141786 - ], - "translation_xyz_cm": [ - -0.9585249532476858, - 2.002012021005495, - 2.5649193253141784 - ], - "translation_norm_m": 0.033919954840210396, - "rotation_rpy_deg_xyz": [ - 0.24362672487551884, - 1.2983115155004061, - -0.27552988255483607 - ], - "rotation_angle_deg": 1.3499624655959195, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.00474423757188136, - -0.02989429283118339, - -0.07269746690809828 - ], - "translation_xyz_cm": [ - 0.474423757188136, - -2.989429283118339, - -7.269746690809828 - ], - "translation_norm_m": 0.07874705219161564, - "rotation_rpy_deg_xyz": [ - 0.5839319721005682, - 0.6616317959527356, - -0.0744053672041109 - ], - "rotation_angle_deg": 0.8858708485334875, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.020000911777368735, - 0.013436484145499694, - -0.14809099639151968 - ], - "translation_xyz_cm": [ - 2.0000911777368735, - 1.3436484145499694, - -14.809099639151968 - ], - "translation_norm_m": 0.15003839105492783, - "rotation_rpy_deg_xyz": [ - -0.15533796803168565, - 1.1895792312009235, - -0.028857051956012215 - ], - "rotation_angle_deg": 1.199986414862301, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.006233568711064397, - 0.02806714089102158, - -0.1423020245626673 - ], - "translation_xyz_cm": [ - 0.6233568711064397, - 2.806714089102158, - -14.23020245626673 - ], - "translation_norm_m": 0.14517743616452933, - "rotation_rpy_deg_xyz": [ - -0.42198341765651226, - 1.466269951561673, - 0.21171491461165698 - ], - "rotation_angle_deg": 1.5411407266368493, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.016525316098469744, - 0.01800655906280857, - -0.043168467603277895 - ], - "translation_xyz_cm": [ - -1.6525316098469744, - 1.800655906280857, - -4.316846760327789 - ], - "translation_norm_m": 0.0496068426394183, - "rotation_rpy_deg_xyz": [ - 0.1280803314427457, - 0.32139899349149403, - 0.08022065036519341 - ], - "rotation_angle_deg": 0.35507680709487327, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.028372969640952372, - 0.02334221220135546, - -0.07293590563828914 - ], - "translation_xyz_cm": [ - -2.8372969640952372, - 2.334221220135546, - -7.293590563828914 - ], - "translation_norm_m": 0.08166719419679441, - "rotation_rpy_deg_xyz": [ - 0.30281490802353767, - 1.0496219755534346, - 0.32932930573176367 - ], - "rotation_angle_deg": 1.1401877864606542, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00785615925959171, - 0.012654500325033458, - -0.03971085428199387 - ], - "translation_xyz_cm": [ - -0.7856159259591711, - 1.2654500325033458, - -3.971085428199387 - ], - "translation_norm_m": 0.04241235155699447, - "rotation_rpy_deg_xyz": [ - 0.5027405314396843, - 0.7642908697969957, - 0.25285723494785856 - ], - "rotation_angle_deg": 0.9482217705558498, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.012590795270947419, - 0.0015740977476244034, - 0.06068024226242286 - ], - "translation_xyz_cm": [ - 1.259079527094742, - 0.15740977476244034, - 6.068024226242286 - ], - "translation_norm_m": 0.06199272304311464, - "rotation_rpy_deg_xyz": [ - 1.2838388210190854, - 0.2586980314758133, - -0.2623748508220815 - ], - "rotation_angle_deg": 1.3362344343892647, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.0057668633578953354, - 0.01299566497435567, - -0.0009327122882002298 - ], - "translation_xyz_cm": [ - -0.5766863357895335, - 1.299566497435567, - -0.09327122882002298 - ], - "translation_norm_m": 0.014248297207978584, - "rotation_rpy_deg_xyz": [ - 1.1250297399899591, - 0.6954550997893817, - 0.4154700312316388 - ], - "rotation_angle_deg": 1.3842934534696463, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.02414791489895718, - 0.017874732227871615, - 0.10362701833809228 - ], - "translation_xyz_cm": [ - 2.414791489895718, - 1.7874732227871615, - 10.362701833809227 - ], - "translation_norm_m": 0.1078943315277902, - "rotation_rpy_deg_xyz": [ - 2.0049131936089957, - -0.05943821892621762, - -0.485703199585355 - ], - "rotation_angle_deg": 2.0635122375670973, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.009601028372025588, - 0.012360871696744269, - 0.01924842590345388 - ], - "translation_xyz_cm": [ - 0.9601028372025588, - 1.2360871696744269, - 1.924842590345388 - ], - "translation_norm_m": 0.024808724164385565, - "rotation_rpy_deg_xyz": [ - 1.6605159980497415, - 0.7519697116324603, - 0.21490122936100178 - ], - "rotation_angle_deg": 1.8341830627801063, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.013498938200056543, - 0.013617534886771532, - -0.0018153090248232001 - ], - "translation_xyz_cm": [ - 1.3498938200056543, - 1.3617534886771532, - -0.18153090248232 - ], - "translation_norm_m": 0.019260164479489528, - "rotation_rpy_deg_xyz": [ - 0.6525841363028939, - 1.3498374643306124, - -0.48973704842693533 - ], - "rotation_angle_deg": 1.5796409695156886, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.0006212994302268182, - -0.016817999148376173, - 0.010109239915849368 - ], - "translation_xyz_cm": [ - 0.06212994302268182, - -1.6817999148376173, - 1.0109239915849368 - ], - "translation_norm_m": 0.019632316216202917, - "rotation_rpy_deg_xyz": [ - -0.6234337925394615, - -0.16160915544313809, - -0.6962293131506193 - ], - "rotation_angle_deg": 0.9490739709789948, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006813887848347022, - 0.041691034775795166, - 0.08615026037189365 - ], - "translation_xyz_cm": [ - -0.6813887848347022, - 4.169103477579517, - 8.615026037189365 - ], - "translation_norm_m": 0.09595018921519374, - "rotation_rpy_deg_xyz": [ - -1.4009784771910934, - -0.5767228112279817, - 0.6079524641453382 - ], - "rotation_angle_deg": 1.629829664042327, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021419292108882715, - 0.0274731295024373, - 0.07426304693289094 - ], - "translation_xyz_cm": [ - 2.1419292108882715, - 2.74731295024373, - 7.426304693289095 - ], - "translation_norm_m": 0.0820277944288404, - "rotation_rpy_deg_xyz": [ - -0.7491674064703252, - -0.1949038344071203, - 0.4852401386300048 - ], - "rotation_angle_deg": 0.9129384235196228, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.009864014653798048, - -0.02316364562764356, - 0.030616908253622087 - ], - "translation_xyz_cm": [ - -0.9864014653798048, - -2.316364562764356, - 3.061690825362209 - ], - "translation_norm_m": 0.03963897494719188, - "rotation_rpy_deg_xyz": [ - 0.5683666859487644, - -0.7314881444565557, - -0.13279725363511663 - ], - "rotation_angle_deg": 0.9352979853680756, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005233509361304733, - 0.0017130600246506034, - 0.040178879873334614 - ], - "translation_xyz_cm": [ - -0.5233509361304733, - 0.17130600246506034, - 4.017887987333461 - ], - "translation_norm_m": 0.04055448905804108, - "rotation_rpy_deg_xyz": [ - 0.28734904403602907, - -1.306375348377909, - 0.23032119910383025 - ], - "rotation_angle_deg": 1.3578427344423345, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01455167766757759, - 0.011099530712334993, - 0.04025903785197042 - ], - "translation_xyz_cm": [ - -1.455167766757759, - 1.1099530712334993, - 4.025903785197042 - ], - "translation_norm_m": 0.04422376096332752, - "rotation_rpy_deg_xyz": [ - -1.1144200334606658, - -1.187419979950182, - 0.16632373412545948 - ], - "rotation_angle_deg": 1.6357487985785641, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009327574091711588, - 0.022873347622626383, - -0.04769694329281031 - ], - "translation_xyz_cm": [ - 0.9327574091711588, - 2.2873347622626383, - -4.769694329281031 - ], - "translation_norm_m": 0.05371398392764625, - "rotation_rpy_deg_xyz": [ - -0.682840221725416, - -0.36328106706508645, - 0.0809169290041293 - ], - "rotation_angle_deg": 0.7774570463748758, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005962688283054796, - 0.005870392133145108, - -0.01700452047671966 - ], - "translation_xyz_cm": [ - -0.5962688283054796, - 0.5870392133145108, - -1.7004520476719658 - ], - "translation_norm_m": 0.018951751159218745, - "rotation_rpy_deg_xyz": [ - -0.18923362632332452, - -0.25461349024112484, - -0.05611730080946054 - ], - "rotation_angle_deg": 0.32223232246641503, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.011123319682821542, - 0.02638097097667913, - -0.034481637439926244 - ], - "translation_xyz_cm": [ - 1.1123319682821542, - 2.638097097667913, - -3.4481637439926245 - ], - "translation_norm_m": 0.04481815693418411, - "rotation_rpy_deg_xyz": [ - 0.5855517523063751, - 0.26287741871452636, - -0.1521004980495623 - ], - "rotation_angle_deg": 0.6599376762552417, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014701045946651448, - 0.014044368243739114, - -0.04054708247477895 - ], - "translation_xyz_cm": [ - 1.4701045946651448, - 1.4044368243739114, - -4.054708247477895 - ], - "translation_norm_m": 0.04535891233823658, - "rotation_rpy_deg_xyz": [ - 0.7843133409749595, - 0.17971185770288187, - -0.08518115643616422 - ], - "rotation_angle_deg": 0.8092641869389188, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0030447836005043083, - 0.0033624909817165927, - 0.01932921883778843 - ], - "translation_xyz_cm": [ - 0.30447836005043083, - 0.33624909817165927, - 1.932921883778843 - ], - "translation_norm_m": 0.0198543635922973, - "rotation_rpy_deg_xyz": [ - 1.0659723254984081, - -0.19917362622106505, - 0.016332803861987624 - ], - "rotation_angle_deg": 1.0845705429864414, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.17961557028165398, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.12394013343025478, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143983507484, - 0.0011901746480735614, - 0.7136919554572032 - ], - "rotation_rpy_deg_xyz": [ - -0.8895495264961033, - 1.501168742146643, - -0.8377113510014426 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10164837804314657, - "median": 0.057266176816710715, - "p90": 0.1597837531076453, - "p95": 0.20912905335657667, - "max": 0.335920408201603 - }, - "rotation_deg": { - "rms": 1.1049105360171487, - "median": 0.8906158400390636, - "p90": 1.6982432293171923, - "p95": 1.9151062405727775, - "max": 2.654107606581579 - }, - "normalized_pair_score": { - "rms": 3.0027098217989345, - "median": 2.489905952758339, - "p90": 4.707686979009194, - "p95": 4.824968708498269, - "max": 6.941070286922221 - }, - "normalized_global_rms": 3.0027098217989345 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.012419233668043428, - 0.013126146662394755, - 0.07397728431804074 - ], - "translation_xyz_cm": [ - -1.2419233668043428, - 1.3126146662394755, - 7.397728431804074 - ], - "translation_norm_m": 0.0761522927177928, - "rotation_rpy_deg_xyz": [ - -0.47015582876024664, - -0.07760383842498442, - 0.026396404936590005 - ], - "rotation_angle_deg": 0.47723032409407057, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6886059172123598, - "median": 0.7291535778684739, - "p90": 2.3232842191178094, - "p95": 3.7417816215363167, - "max": 5.703566170764175 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.05340926734199069, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.012419233668043428, - 0.013126146662394755, - 0.07397728431804074 - ], - "translation_xyz_cm": [ - -1.2419233668043428, - 1.3126146662394755, - 7.397728431804074 - ], - "translation_norm_m": 0.0761522927177928, - "rotation_rpy_deg_xyz": [ - -0.47015582876024664, - -0.07760383842498442, - 0.026396404936590005 - ], - "rotation_angle_deg": 0.47723032409407057, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.021184266244200556, - -0.01623694562891087, - 0.12542129174055922 - ], - "translation_xyz_cm": [ - 2.1184266244200556, - -1.623694562891087, - 12.54212917405592 - ], - "translation_norm_m": 0.1282299183557872, - "rotation_rpy_deg_xyz": [ - -0.19771040370425846, - -0.13408915231264432, - -0.34281707909633174 - ], - "rotation_angle_deg": 0.41803263983275235, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03440893176205129, - 0.0068739739603926875, - 0.1010280105347148 - ], - "translation_xyz_cm": [ - 3.4408931762051287, - 0.6873973960392687, - 10.102801053471481 - ], - "translation_norm_m": 0.10694804820853956, - "rotation_rpy_deg_xyz": [ - -0.10616449155959552, - -0.14941616391528942, - -0.3968149103030593 - ], - "rotation_angle_deg": 0.4372274949422868, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03460869076079831, - -0.01913652342124672, - 0.04413294492525292 - ], - "translation_xyz_cm": [ - 3.460869076079831, - -1.913652342124672, - 4.413294492525292 - ], - "translation_norm_m": 0.05925947040434886, - "rotation_rpy_deg_xyz": [ - 0.31797599530131704, - 0.10997624846666197, - -0.34935234414195465 - ], - "rotation_angle_deg": 0.48524572178978786, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04680178594658846, - 0.010798103274652582, - 0.02120079672230956 - ], - "translation_xyz_cm": [ - 4.680178594658846, - 1.0798103274652582, - 2.120079672230956 - ], - "translation_norm_m": 0.052502190276035525, - "rotation_rpy_deg_xyz": [ - 0.4898731043359302, - 0.33270954679875137, - -0.37964989936230714 - ], - "rotation_angle_deg": 0.7041898566394693, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.015070898720730475, - 0.00827654803150546, - -0.035785795426210694 - ], - "translation_xyz_cm": [ - 1.5070898720730475, - 0.827654803150546, - -3.5785795426210694 - ], - "translation_norm_m": 0.03970209553480691, - "rotation_rpy_deg_xyz": [ - 0.6972383042059144, - 0.3179884216721907, - 0.1396934174085441 - ], - "rotation_angle_deg": 0.7786077567447587, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00566751402637553, - 0.020376421622713886, - -0.010217623314503382 - ], - "translation_xyz_cm": [ - 0.566751402637553, - 2.0376421622713887, - -1.0217623314503381 - ], - "translation_norm_m": 0.023488701530370904, - "rotation_rpy_deg_xyz": [ - 0.32832796765544886, - 0.24373678161622353, - -0.03203468285134926 - ], - "rotation_angle_deg": 0.4102166137663221, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031519899057299634, - -0.0007796807997476618, - -0.07204047748964844 - ], - "translation_xyz_cm": [ - -3.1519899057299634, - -0.07796807997476618, - -7.204047748964844 - ], - "translation_norm_m": 0.07863804636223103, - "rotation_rpy_deg_xyz": [ - 0.7028390759989444, - 0.6113889756994517, - 0.5393475127259789 - ], - "rotation_angle_deg": 1.0745319358398877, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.02879543918299879, - -0.018182993343084264, - -0.13043862728603106 - ], - "translation_xyz_cm": [ - -2.8795439182998788, - -1.8182993343084264, - -13.043862728603106 - ], - "translation_norm_m": 0.13481110508011035, - "rotation_rpy_deg_xyz": [ - 0.813193554853031, - 0.4778422412784806, - 0.4060722121258889 - ], - "rotation_angle_deg": 1.025548672967319, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.030686122709684335, - -0.020923944115331772, - -0.051487506126032166 - ], - "translation_xyz_cm": [ - -3.0686122709684334, - -2.092394411533177, - -5.148750612603217 - ], - "translation_norm_m": 0.06348553261471097, - "rotation_rpy_deg_xyz": [ - 0.5787092936959236, - 0.4076947521841255, - 0.5890867177935492 - ], - "rotation_angle_deg": 0.9196254710001934, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03691610150837312, - -0.03883555129640065, - -0.07795012584219917 - ], - "translation_xyz_cm": [ - -3.6916101508373123, - -3.883555129640065, - -7.795012584219917 - ], - "translation_norm_m": 0.09458974951804534, - "rotation_rpy_deg_xyz": [ - 0.7734528516471484, - 0.8881621926582501, - 0.5068294049362794 - ], - "rotation_angle_deg": 1.2797811340957572, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012845059483986336, - -0.010933651452035148, - -0.030718232882454496 - ], - "translation_xyz_cm": [ - -1.2845059483986336, - -1.093365145203515, - -3.0718232882454495 - ], - "translation_norm_m": 0.035044972801279876, - "rotation_rpy_deg_xyz": [ - 0.3933734152775861, - 0.30641907301491916, - -0.08542700923560093 - ], - "rotation_angle_deg": 0.506075458723862, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.014164589266999705, - -0.0025005542758458343, - -0.2105644378551853 - ], - "translation_xyz_cm": [ - 1.4164589266999705, - -0.25005542758458343, - -21.056443785518532 - ], - "translation_norm_m": 0.21105513699045433, - "rotation_rpy_deg_xyz": [ - 0.10199885756952803, - 0.2713184434115643, - 0.3008037156416099 - ], - "rotation_angle_deg": 0.4175581849080869, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.011857806542527882, - 0.01755109388274949, - -0.19557566060037046 - ], - "translation_xyz_cm": [ - 1.1857806542527882, - 1.755109388274949, - -19.557566060037047 - ], - "translation_norm_m": 0.19671931143574187, - "rotation_rpy_deg_xyz": [ - 0.21132942240753252, - -0.0030475518874055686, - 0.4038957243782797 - ], - "rotation_angle_deg": 0.45585691126526523, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0046044491337547955, - 0.005772189947446549, - -0.1343226472826804 - ], - "translation_xyz_cm": [ - -0.46044491337547955, - 0.5772189947446549, - -13.43226472826804 - ], - "translation_norm_m": 0.13452543514756643, - "rotation_rpy_deg_xyz": [ - 0.619268866213009, - -0.13846281487745113, - -0.08693898709539695 - ], - "rotation_angle_deg": 0.6403857394117293, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.009110417257375047, - 0.01538326208429952, - -0.13954492950924077 - ], - "translation_xyz_cm": [ - 0.9110417257375047, - 1.538326208429952, - -13.954492950924077 - ], - "translation_norm_m": 0.14068557782053107, - "rotation_rpy_deg_xyz": [ - -0.7265026815110706, - 0.7264000231555012, - 0.2931587247335926 - ], - "rotation_angle_deg": 1.0696242278852288, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.00871211769984781, - -0.00293124596012162, - -0.06343312080889037 - ], - "translation_xyz_cm": [ - -0.871211769984781, - -0.293124596012162, - -6.343312080889037 - ], - "translation_norm_m": 0.06409566298315364, - "rotation_rpy_deg_xyz": [ - -0.6130593636006771, - 0.3375975509047987, - -0.208407214957789 - ], - "rotation_angle_deg": 0.7297211852100517, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.008278730448752158, - -0.020518204812521534, - 0.07216396724527915 - ], - "translation_xyz_cm": [ - -0.8278730448752158, - -2.0518204812521534, - 7.2163967245279155 - ], - "translation_norm_m": 0.07547961496423654, - "rotation_rpy_deg_xyz": [ - 0.38163211427592636, - -0.3085201833066701, - -0.4808803300236558 - ], - "rotation_angle_deg": 0.6863553779619226, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.002271082939057756, - -0.003222014597859535, - 0.002176082269295731 - ], - "translation_xyz_cm": [ - 0.22710829390577558, - -0.3222014597859535, - 0.2176082269295731 - ], - "translation_norm_m": 0.004502724711509956, - "rotation_rpy_deg_xyz": [ - 0.2929147676390593, - -0.20568025194900466, - -0.4742402334670874 - ], - "rotation_angle_deg": 0.5937236199068581, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.006334113981433687, - 0.01414006937034018, - -0.07048422784411384 - ], - "translation_xyz_cm": [ - 0.6334113981433687, - 1.414006937034018, - -7.048422784411384 - ], - "translation_norm_m": 0.07216709039797005, - "rotation_rpy_deg_xyz": [ - -0.5781444390744482, - -0.20822019250473564, - -0.3039414367583841 - ], - "rotation_angle_deg": 0.6860206855604611, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0107333774452667, - 0.020204832039175336, - -0.06378142328297087 - ], - "translation_xyz_cm": [ - 1.07333774452667, - 2.0204832039175336, - -6.378142328297088 - ], - "translation_norm_m": 0.06776068613226512, - "rotation_rpy_deg_xyz": [ - 0.117394315264257, - 0.036560300250528, - 0.007735778504693242 - ], - "rotation_angle_deg": 0.12319635996888008, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01348975060603097, - 0.03963492985620953, - -0.11387896994248202 - ], - "translation_xyz_cm": [ - 1.348975060603097, - 3.9634929856209533, - -11.387896994248202 - ], - "translation_norm_m": 0.12133145029744055, - "rotation_rpy_deg_xyz": [ - -0.8208318571695001, - -0.13446048559291, - 0.16958546422795645 - ], - "rotation_angle_deg": 0.8486909337785505, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.007199367236066789, - 0.016262389478755246, - -0.05452822344724287 - ], - "translation_xyz_cm": [ - 0.7199367236066789, - 1.6262389478755246, - -5.452822344724287 - ], - "translation_norm_m": 0.0573552382304435, - "rotation_rpy_deg_xyz": [ - -0.8732407226275165, - -0.04841272798119736, - 0.16675739451234076 - ], - "rotation_angle_deg": 0.8902682474721725, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0010471899824484598, - -0.016795448978287997, - -0.1702140712929781 - ], - "translation_xyz_cm": [ - -0.10471899824484598, - -1.6795448978287997, - -17.02140712929781 - ], - "translation_norm_m": 0.17104389430603084, - "rotation_rpy_deg_xyz": [ - -0.4040019179507355, - 1.7099426788442662, - -0.3311981408610053 - ], - "rotation_angle_deg": 1.7868407114310305, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.00292548448408686, - 0.011529644689981078, - -0.03744314241847349 - ], - "translation_xyz_cm": [ - -0.292548448408686, - 1.1529644689981078, - -3.744314241847349 - ], - "translation_norm_m": 0.03928714904792572, - "rotation_rpy_deg_xyz": [ - 0.6021089721690386, - 0.42487128301300503, - 0.2048159750967479 - ], - "rotation_angle_deg": 0.7642536795724175, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.0148463224625357, - 0.020325664114488884, - -0.03768336298312086 - ], - "translation_xyz_cm": [ - 1.48463224625357, - 2.0325664114488884, - -3.768336298312086 - ], - "translation_norm_m": 0.04531646232964635, - "rotation_rpy_deg_xyz": [ - 0.8339041745850586, - 1.0000860306347317, - 0.1983621695456838 - ], - "rotation_angle_deg": 1.3160581889466436, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.002786212629189766, - 0.005802757290271465, - -0.03025689256878872 - ], - "translation_xyz_cm": [ - -0.2786212629189766, - 0.5802757290271465, - -3.0256892568788722 - ], - "translation_norm_m": 0.03093403499228766, - "rotation_rpy_deg_xyz": [ - -0.43951113758236676, - 2.53518275908206, - 0.6415526684504304 - ], - "rotation_angle_deg": 2.654107606581579, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016754514539300436, - 0.014255584339316396, - -0.01039293302835298 - ], - "translation_xyz_cm": [ - 1.6754514539300436, - 1.4255584339316396, - -1.039293302835298 - ], - "translation_norm_m": 0.024329991763969484, - "rotation_rpy_deg_xyz": [ - 0.41106506180252267, - 0.3238393937791646, - -0.010482979295534626 - ], - "rotation_angle_deg": 0.5234312142480787, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - 0.0018361831331945577, - 0.0072541873584552885, - 0.007039442270357016 - ], - "translation_xyz_cm": [ - 0.18361831331945577, - 0.7254187358455289, - 0.7039442270357016 - ], - "translation_norm_m": 0.010273682407388785, - "rotation_rpy_deg_xyz": [ - 0.11004639020415029, - 1.9776096103806078, - 0.4851308992001362 - ], - "rotation_angle_deg": 2.0387581112740842, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.019066389805227457, - 0.007823637220907287, - 0.2373387127250885 - ], - "translation_xyz_cm": [ - 1.9066389805227457, - 0.7823637220907287, - 23.73387127250885 - ], - "translation_norm_m": 0.23823182213459926, - "rotation_rpy_deg_xyz": [ - -0.1413993143911705, - 0.24774739186599706, - -0.28536459062305863 - ], - "rotation_angle_deg": 0.4032751061619503, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0070310934648918355, - -0.008873836049567985, - 0.027542367017527727 - ], - "translation_xyz_cm": [ - 0.7031093464891836, - -0.8873836049567985, - 2.754236701752773 - ], - "translation_norm_m": 0.02977856985274572, - "rotation_rpy_deg_xyz": [ - 0.40981596391605035, - 1.651593713042028, - 0.5257041423097305 - ], - "rotation_angle_deg": 1.779278938996176, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03834057915738032, - -0.008951302280609363, - 0.22887207142941066 - ], - "translation_xyz_cm": [ - 3.8340579157380317, - -0.8951302280609363, - 22.887207142941065 - ], - "translation_norm_m": 0.23223382807642698, - "rotation_rpy_deg_xyz": [ - 0.2999907595514252, - -0.01411939937262211, - -0.23999007941474496 - ], - "rotation_angle_deg": 0.38441016826953633, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.037984943979473274, - 0.006295396080778559, - 0.33370650677712893 - ], - "translation_xyz_cm": [ - 3.7984943979473274, - 0.6295396080778559, - 33.370650677712895 - ], - "translation_norm_m": 0.335920408201603, - "rotation_rpy_deg_xyz": [ - -0.22664375614571414, - 0.8116368883042351, - -0.22575845282884138 - ], - "rotation_angle_deg": 0.8719874525275415, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.008656833199885972, - 0.011303325713131196, - 0.1478396339326658 - ], - "translation_xyz_cm": [ - 0.8656833199885972, - 1.1303325713131196, - 14.78396339326658 - ], - "translation_norm_m": 0.14852361190925978, - "rotation_rpy_deg_xyz": [ - 1.036743210715922, - -1.3689873443058387, - -0.7370443448949371 - ], - "rotation_angle_deg": 1.8638261421190532, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009560935506827573, - 0.022898933294352997, - 0.20183105862400014 - ], - "translation_xyz_cm": [ - -0.9560935506827573, - 2.2898933294352997, - 20.183105862400012 - ], - "translation_norm_m": 0.20335080245494366, - "rotation_rpy_deg_xyz": [ - 0.9390232920032411, - -0.2313066306974258, - -0.6872608352087699 - ], - "rotation_angle_deg": 1.1853173459144088, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003338637112830778, - -0.013123144897042138, - 0.10194043917885307 - ], - "translation_xyz_cm": [ - 0.3338637112830778, - -1.3123144897042138, - 10.194043917885306 - ], - "translation_norm_m": 0.10283587199872123, - "rotation_rpy_deg_xyz": [ - -0.6003323074051949, - 0.6919365436052581, - 0.007548639719645848 - ], - "rotation_angle_deg": 0.9161235656659878, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0021805998687720596, - -0.0054549691448917415, - -0.05584069137681035 - ], - "translation_xyz_cm": [ - 0.21805998687720596, - -0.5454969144891741, - -5.584069137681035 - ], - "translation_norm_m": 0.05614886034105761, - "rotation_rpy_deg_xyz": [ - -0.33854956172323947, - 0.7341086429434062, - 0.09511186202152708 - ], - "rotation_angle_deg": 0.8142410090269525, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0009929261059835603, - 0.025683118873724764, - 0.0290011570425803 - ], - "translation_xyz_cm": [ - 0.09929261059835603, - 2.5683118873724764, - 2.90011570425803 - ], - "translation_norm_m": 0.038751459419513815, - "rotation_rpy_deg_xyz": [ - -0.6888747943185911, - -0.003595076963295106, - -0.7365170174724857 - ], - "rotation_angle_deg": 1.008486005928133, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01585300067187756, - -0.04231642426387827, - -0.019850286899863373 - ], - "translation_xyz_cm": [ - 1.585300067187756, - -4.231642426387827, - -1.9850286899863372 - ], - "translation_norm_m": 0.049356167626650106, - "rotation_rpy_deg_xyz": [ - 0.29631409233498207, - 0.21636237946670253, - -0.6389796436746707 - ], - "rotation_angle_deg": 0.7373080723422089, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.004093251936198694, - 0.011714828228369, - 0.0017009229687299093 - ], - "translation_xyz_cm": [ - 0.4093251936198694, - 1.1714828228369, - 0.17009229687299093 - ], - "translation_norm_m": 0.01252537627294839, - "rotation_rpy_deg_xyz": [ - 0.06453818798347359, - 0.2531958997818171, - 0.14873859440575485 - ], - "rotation_angle_deg": 0.30058949640307114, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.0074382676420592375, - -0.013496189342214915, - -0.004648874392575081 - ], - "translation_xyz_cm": [ - 0.7438267642059238, - -1.3496189342214915, - -0.4648874392575081 - ], - "translation_norm_m": 0.01609617921724784, - "rotation_rpy_deg_xyz": [ - -1.2271551663892637, - -0.9375514877185607, - 0.1537227666995716 - ], - "rotation_angle_deg": 1.5509421133110688, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008059215134474496, - 0.0013320515525209464, - 0.05659061066893641 - ], - "translation_xyz_cm": [ - 0.8059215134474496, - 0.13320515525209464, - 5.659061066893641 - ], - "translation_norm_m": 0.05717711540297793, - "rotation_rpy_deg_xyz": [ - -0.14423507376358805, - -0.11762458382787115, - -0.13071789965054312 - ], - "rotation_angle_deg": 0.22751956500413503, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.004634430615497731, - -0.02714760964830515, - 0.00629506689691596 - ], - "translation_xyz_cm": [ - -0.4634430615497731, - -2.714760964830515, - 0.629506689691596 - ], - "translation_norm_m": 0.028250637585429124, - "rotation_rpy_deg_xyz": [ - 0.9234558485972508, - 0.28392037158155653, - -0.19555335955970282 - ], - "rotation_angle_deg": 0.9861616538646055, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.010514544946069071, - 0.019702237132058542, - 0.02799447185673256 - ], - "translation_xyz_cm": [ - -1.051454494606907, - 1.9702237132058542, - 2.799447185673256 - ], - "translation_norm_m": 0.03581095164845755, - "rotation_rpy_deg_xyz": [ - 0.2717880807331498, - 1.2301742781325742, - -0.27621586715225116 - ], - "rotation_angle_deg": 1.2903870167805274, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0034688318212228175, - -0.03130323956894021, - -0.06699185058230833 - ], - "translation_xyz_cm": [ - 0.34688318212228175, - -3.130323956894021, - -6.699185058230833 - ], - "translation_norm_m": 0.07402589848260349, - "rotation_rpy_deg_xyz": [ - 0.6860847637329365, - 0.5630848868334735, - -0.07443749532817807 - ], - "rotation_angle_deg": 0.8909634326059546, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.019518167940497655, - 0.01104983876197263, - -0.1396714881379001 - ], - "translation_xyz_cm": [ - 1.9518167940497655, - 1.104983876197263, - -13.96714881379001 - ], - "translation_norm_m": 0.14146088652017783, - "rotation_rpy_deg_xyz": [ - 0.037423852847679684, - 1.153586342569134, - -0.024362041491095596 - ], - "rotation_angle_deg": 1.154458224751762, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0063939490140809685, - 0.025666565260984875, - -0.13547355932810853 - ], - "translation_xyz_cm": [ - 0.6393949014080968, - 2.5666565260984875, - -13.547355932810854 - ], - "translation_norm_m": 0.1380316646038785, - "rotation_rpy_deg_xyz": [ - -0.2232080785933722, - 1.4836369126889792, - 0.21710701447252453 - ], - "rotation_angle_deg": 1.5163723667562048, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017634879400806547, - 0.01716591701079595, - -0.04108750262152657 - ], - "translation_xyz_cm": [ - -1.7634879400806547, - 1.716591701079595, - -4.1087502621526575 - ], - "translation_norm_m": 0.047894055476399966, - "rotation_rpy_deg_xyz": [ - 0.18998087893118493, - 0.23037825757725086, - 0.08009690934260924 - ], - "rotation_angle_deg": 0.30906494904159015, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0294912103855558, - 0.021882929854869837, - -0.07172704354627303 - ], - "translation_xyz_cm": [ - -2.94912103855558, - 2.1882929854869837, - -7.172704354627303 - ], - "translation_norm_m": 0.08058140532981052, - "rotation_rpy_deg_xyz": [ - 0.41801005413974385, - 0.9522107901338667, - 0.33013668261644724 - ], - "rotation_angle_deg": 1.0900126378646533, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008496837757615727, - 0.012410484191522464, - -0.03858738168224528 - ], - "translation_xyz_cm": [ - -0.8496837757615727, - 1.2410484191522464, - -3.858738168224528 - ], - "translation_norm_m": 0.04141500205044727, - "rotation_rpy_deg_xyz": [ - 0.5178850309371813, - 0.7128065945110065, - 0.2519511900034406 - ], - "rotation_angle_deg": 0.9155050727175903, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.011499252464089782, - -0.0003824876998570481, - 0.060462718194658746 - ], - "translation_xyz_cm": [ - 1.1499252464089782, - -0.03824876998570481, - 6.046271819465875 - ], - "translation_norm_m": 0.06154770016467012, - "rotation_rpy_deg_xyz": [ - 1.4379245566272494, - 0.17599667393341442, - -0.2616578786714958 - ], - "rotation_angle_deg": 1.4724867231348422, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.006506401211152646, - 0.010529965904201743, - 0.00404656850630819 - ], - "translation_xyz_cm": [ - -0.6506401211152646, - 1.0529965904201743, - 0.404656850630819 - ], - "translation_norm_m": 0.01302260171165444, - "rotation_rpy_deg_xyz": [ - 1.3084468296008804, - 0.641692409133129, - 0.41825282942558634 - ], - "rotation_angle_deg": 1.5141272142703541, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.022948223713993077, - 0.016800143593684425, - 0.09911674316373702 - ], - "translation_xyz_cm": [ - 2.2948223713993077, - 1.6800143593684425, - 9.911674316373702 - ], - "translation_norm_m": 0.10311641271777301, - "rotation_rpy_deg_xyz": [ - 2.1077471070101943, - -0.1579377856914185, - -0.4881611141442496 - ], - "rotation_angle_deg": 2.1686349143849633, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.008404847844856178, - 0.010372673178159264, - 0.023494623647401125 - ], - "translation_xyz_cm": [ - 0.8404847844856178, - 1.0372673178159264, - 2.3494623647401127 - ], - "translation_norm_m": 0.027022789576376237, - "rotation_rpy_deg_xyz": [ - 1.8034035496908418, - 0.6630521981477719, - 0.21449918444849755 - ], - "rotation_angle_deg": 1.9321996067240188, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.012704405041615185, - 0.011163546426760984, - 0.0033748486252146437 - ], - "translation_xyz_cm": [ - 1.2704405041615185, - 1.1163546426760984, - 0.33748486252146437 - ], - "translation_norm_m": 0.01724576120462586, - "rotation_rpy_deg_xyz": [ - 0.8343187439759819, - 1.2935772732676656, - -0.4866288398791267 - ], - "rotation_angle_deg": 1.6172075196382085, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -6.0160644302253985e-05, - -0.016941753025082273, - 0.011704261623593865 - ], - "translation_xyz_cm": [ - -0.0060160644302253985, - -1.6941753025082273, - 1.1704261623593863 - ], - "translation_norm_m": 0.020591657413125814, - "rotation_rpy_deg_xyz": [ - -0.6098559653610494, - -0.2104841348055634, - -0.6961491081736637 - ], - "rotation_angle_deg": 0.9499502926148303, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005985735008223969, - 0.04160234367566362, - 0.08088924194935303 - ], - "translation_xyz_cm": [ - -0.5985735008223969, - 4.160234367566362, - 8.088924194935302 - ], - "translation_norm_m": 0.09115730078297449, - "rotation_rpy_deg_xyz": [ - -1.388912470808575, - -0.527612799921019, - 0.6078781707282284 - ], - "rotation_angle_deg": 1.6028599259815544, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02297304104359288, - 0.02669474361513835, - 0.06560673111578437 - ], - "translation_xyz_cm": [ - 2.297304104359288, - 2.669474361513835, - 6.560673111578437 - ], - "translation_norm_m": 0.07446215897465908, - "rotation_rpy_deg_xyz": [ - -0.6779656892448027, - -0.09767328619455794, - 0.487488848966946 - ], - "rotation_angle_deg": 0.8403907255004832, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.008874668818862563, - -0.023432275277618597, - 0.027910208389937914 - ], - "translation_xyz_cm": [ - -0.8874668818862563, - -2.3432275277618597, - 2.7910208389937914 - ], - "translation_norm_m": 0.03750747930347157, - "rotation_rpy_deg_xyz": [ - 0.5963737367104955, - -0.6606106196423976, - -0.13017922242717084 - ], - "rotation_angle_deg": 0.8989523068464468, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004312142517042705, - 0.001533401115344335, - 0.03740916865299525 - ], - "translation_xyz_cm": [ - -0.4312142517042705, - 0.1533401115344335, - 3.740916865299525 - ], - "translation_norm_m": 0.03768808553609574, - "rotation_rpy_deg_xyz": [ - 0.30824911641621877, - -1.2436789195974014, - 0.2322245575380892 - ], - "rotation_angle_deg": 1.3027781244375134, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.013083444477408612, - 0.009907509202872311, - 0.03568946170345781 - ], - "translation_xyz_cm": [ - -1.3083444477408612, - 0.9907509202872311, - 3.568946170345781 - ], - "translation_norm_m": 0.03928196704190124, - "rotation_rpy_deg_xyz": [ - -1.0183099608795763, - -1.0860243879665021, - 0.16861844370543996 - ], - "rotation_angle_deg": 1.4971803658410243, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01039056824918716, - 0.021027548433870447, - -0.04726816658205513 - ], - "translation_xyz_cm": [ - 1.039056824918716, - 2.1027548433870447, - -4.726816658205513 - ], - "translation_norm_m": 0.052767426256249195, - "rotation_rpy_deg_xyz": [ - -0.5344374778893852, - -0.27438589861999546, - 0.08531833282420781 - ], - "rotation_angle_deg": 0.6066063647907448, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00494378848905197, - 0.005461333037447114, - -0.019602928704850666 - ], - "translation_xyz_cm": [ - -0.494378848905197, - 0.5461333037447114, - -1.9602928704850666 - ], - "translation_norm_m": 0.020941394819301132, - "rotation_rpy_deg_xyz": [ - -0.1545979541873174, - -0.17746325052671524, - -0.054176067166299885 - ], - "rotation_angle_deg": 0.2415671694603592, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012270691734974859, - 0.02525920665084258, - -0.0326791782569357 - ], - "translation_xyz_cm": [ - 1.227069173497486, - 2.525920665084258, - -3.2679178256935697 - ], - "translation_norm_m": 0.04308742377809712, - "rotation_rpy_deg_xyz": [ - 0.6688442153717401, - 0.36283957770697794, - -0.14718443094951217 - ], - "rotation_angle_deg": 0.7754289162658738, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015308059223417825, - 0.013790358186051122, - -0.03963449267029259 - ], - "translation_xyz_cm": [ - 1.5308059223417825, - 1.3790358186051122, - -3.9634492670292594 - ], - "translation_norm_m": 0.0446699414071558, - "rotation_rpy_deg_xyz": [ - 0.7980048956471144, - 0.23166125100071297, - -0.08325283104002376 - ], - "rotation_angle_deg": 0.8352708612617049, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.003605660117083964, - 0.0032810312248816587, - 0.018760212835223056 - ], - "translation_xyz_cm": [ - 0.3605660117083964, - 0.32810312248816587, - 1.8760212835223056 - ], - "translation_norm_m": 0.019383279815383316, - "rotation_rpy_deg_xyz": [ - 1.075024130982001, - -0.15612850100659434, - 0.018080934453996177 - ], - "rotation_angle_deg": 1.0864769452132907, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.14706843035628658, - "improved_pairs": 25, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.11484993145673816, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143971201475, - -0.0013248359682619102, - 0.713691720431845 - ], - "rotation_rpy_deg_xyz": [ - -0.6895047465055957, - 1.5040854381408757, - -0.833512808459901 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.09942680753866891, - "median": 0.05740183449190977, - "p90": 0.1584915028651408, - "p95": 0.2094337164564074, - "max": 0.3257392780201393 - }, - "rotation_deg": { - "rms": 1.1159092500059349, - "median": 0.8822504771897199, - "p90": 1.7591229803689168, - "p95": 1.9458390054885353, - "max": 2.453103621998225 - }, - "normalized_pair_score": { - "rms": 2.989195517179804, - "median": 2.4795196690607835, - "p90": 4.738248960961586, - "p95": 4.900551348948156, - "max": 6.672530800967258 - }, - "normalized_global_rms": 2.989195517179804 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.013089292628538585, - 0.013303518193552799, - 0.07537496809953247 - ], - "translation_xyz_cm": [ - -1.3089292628538585, - 1.33035181935528, - 7.537496809953247 - ], - "translation_norm_m": 0.07765113646204569, - "rotation_rpy_deg_xyz": [ - -0.46420951166002233, - -0.12318592757090256, - 0.02629593916442142 - ], - "rotation_angle_deg": 0.48096817789925783, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6556931398905776, - "median": 0.7038478902798858, - "p90": 2.246336260565, - "p95": 3.6834655103174776, - "max": 5.511875843494262 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.013089292628538585, - 0.013303518193552799, - 0.07537496809953247 - ], - "translation_xyz_cm": [ - -1.3089292628538585, - 1.33035181935528, - 7.537496809953247 - ], - "translation_norm_m": 0.07765113646204569, - "rotation_rpy_deg_xyz": [ - -0.46420951166002233, - -0.12318592757090256, - 0.02629593916442142 - ], - "rotation_angle_deg": 0.48096817789925783, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019837432632139107, - -0.016139020290202533, - 0.12710201824625125 - ], - "translation_xyz_cm": [ - 1.9837432632139107, - -1.6139020290202533, - 12.710201824625125 - ], - "translation_norm_m": 0.12964919880829426, - "rotation_rpy_deg_xyz": [ - -0.1757143536058827, - -0.22241153503700828, - -0.34316936395109443 - ], - "rotation_angle_deg": 0.44535539842024163, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03238583969692399, - 0.0065294353649325565, - 0.10323305104528144 - ], - "translation_xyz_cm": [ - 3.238583969692399, - 0.6529435364932556, - 10.323305104528144 - ], - "translation_norm_m": 0.10839067749201207, - "rotation_rpy_deg_xyz": [ - -0.053477542941272445, - -0.28182052328638574, - -0.39707289457553935 - ], - "rotation_angle_deg": 0.4899527012149992, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.033983266720985505, - -0.019065983678909604, - 0.04502524016578025 - ], - "translation_xyz_cm": [ - 3.3983266720985505, - -1.9065983678909604, - 4.502524016578025 - ], - "translation_norm_m": 0.059545330653715235, - "rotation_rpy_deg_xyz": [ - 0.32384482008354293, - 0.06470587093450712, - -0.35007582267962295 - ], - "rotation_angle_deg": 0.48139700963600973, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0454919768885107, - 0.010605222857977492, - 0.02273106784603056 - ], - "translation_xyz_cm": [ - 4.54919768885107, - 1.0605222857977492, - 2.2731067846030557 - ], - "translation_norm_m": 0.0519489379921573, - "rotation_rpy_deg_xyz": [ - 0.5155559162542533, - 0.2375208628762036, - -0.38112308388010996 - ], - "rotation_angle_deg": 0.6843112259317502, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.012908245743412955, - 0.007052585194783134, - -0.0343380630187217 - ], - "translation_xyz_cm": [ - 1.2908245743412956, - 0.7052585194783134, - -3.43380630187217 - ], - "translation_norm_m": 0.03735591436412333, - "rotation_rpy_deg_xyz": [ - 0.7928733271967247, - 0.15025099561044367, - 0.1377095209774396 - ], - "rotation_angle_deg": 0.8184744259545885, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.004983135978955691, - 0.020276831984999466, - -0.0095083138609501 - ], - "translation_xyz_cm": [ - 0.4983135978955691, - 2.027683198499947, - -0.9508313860950101 - ], - "translation_norm_m": 0.0229431818196822, - "rotation_rpy_deg_xyz": [ - 0.3363109074938519, - 0.19062529543788628, - -0.032865210258438374 - ], - "rotation_angle_deg": 0.3880203820695361, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03318725764135524, - -0.0016548034047579319, - -0.07121911621631889 - ], - "translation_xyz_cm": [ - -3.318725764135524, - -0.1654803404757932, - -7.121911621631889 - ], - "translation_norm_m": 0.0785894074204382, - "rotation_rpy_deg_xyz": [ - 0.7624913951896787, - 0.4717664298919329, - 0.5372030284413439 - ], - "rotation_angle_deg": 1.043629201856332, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030865605298225962, - -0.019713214882646768, - -0.12914633973002076 - ], - "translation_xyz_cm": [ - -3.086560529822596, - -1.9713214882646768, - -12.914633973002076 - ], - "translation_norm_m": 0.13423886731158463, - "rotation_rpy_deg_xyz": [ - 0.9248230859935033, - 0.30129558162761494, - 0.40389011749123904 - ], - "rotation_angle_deg": 1.0522518128951979, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03183701523864235, - -0.021402739118916825, - -0.0511745115325515 - ], - "translation_xyz_cm": [ - -3.183701523864235, - -2.1402739118916827, - -5.11745115325515 - ], - "translation_norm_m": 0.06395704348774421, - "rotation_rpy_deg_xyz": [ - 0.605504263644743, - 0.3105527747182122, - 0.58744709933869 - ], - "rotation_angle_deg": 0.8979084676293785, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.038614370341891247, - -0.03984567058915456, - -0.07699103065683538 - ], - "translation_xyz_cm": [ - -3.861437034189125, - -3.984567058915456, - -7.699103065683538 - ], - "translation_norm_m": 0.09490187491931817, - "rotation_rpy_deg_xyz": [ - 0.8405034123607513, - 0.7416054387442135, - 0.5045048250211195 - ], - "rotation_angle_deg": 1.2269650496836761, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013631978420701359, - -0.011133638199885748, - -0.029921060365260255 - ], - "translation_xyz_cm": [ - -1.3631978420701358, - -1.113363819988575, - -2.9921060365260255 - ], - "translation_norm_m": 0.03471395380261331, - "rotation_rpy_deg_xyz": [ - 0.404444080485733, - 0.2436396754344723, - -0.08643879159036653 - ], - "rotation_angle_deg": 0.48016178635002466, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012537737931094028, - -0.004585997481778584, - -0.21179725453278872 - ], - "translation_xyz_cm": [ - 1.2537737931094028, - -0.45859974817785837, - -21.179725453278873 - ], - "translation_norm_m": 0.21221758474018726, - "rotation_rpy_deg_xyz": [ - 0.25362038504030376, - 0.0801190392064761, - 0.30155316597167203 - ], - "rotation_angle_deg": 0.4019571533332662, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.010429137420876144, - 0.016012663211219177, - -0.19737123338391027 - ], - "translation_xyz_cm": [ - 1.0429137420876144, - 1.6012663211219178, - -19.737123338391026 - ], - "translation_norm_m": 0.198294165466222, - "rotation_rpy_deg_xyz": [ - 0.30434581689490686, - -0.1691601559838173, - 0.40329922693347425 - ], - "rotation_angle_deg": 0.5331544036903919, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.006662762576638559, - 0.0033421051521627665, - -0.13233421652925653 - ], - "translation_xyz_cm": [ - -0.6662762576638559, - 0.33421051521627665, - -13.233421652925653 - ], - "translation_norm_m": 0.1325439811398953, - "rotation_rpy_deg_xyz": [ - 0.8070116442024338, - -0.3352342793745047, - -0.08717429731943552 - ], - "rotation_angle_deg": 0.8779724090783606, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.008280248130208667, - 0.01470277037446932, - -0.13863341397473403 - ], - "translation_xyz_cm": [ - 0.8280248130208667, - 1.470277037446932, - -13.863341397473402 - ], - "translation_norm_m": 0.13965656961300524, - "rotation_rpy_deg_xyz": [ - -0.7076095049554771, - 0.6444128042247022, - 0.2935505305988037 - ], - "rotation_angle_deg": 1.0022374714144187, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.010593423077150554, - -0.004098754422540818, - -0.0594462281547542 - ], - "translation_xyz_cm": [ - -1.0593423077150554, - -0.4098754422540818, - -5.9446228154754195 - ], - "translation_norm_m": 0.06052168571788871, - "rotation_rpy_deg_xyz": [ - -0.5307955027281175, - 0.17880444959878763, - -0.20685250915159892 - ], - "rotation_angle_deg": 0.5967911222445244, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.009664356318276779, - -0.02065178566907251, - 0.07401633730193319 - ], - "translation_xyz_cm": [ - -0.9664356318276779, - -2.0651785669072513, - 7.401633730193319 - ], - "translation_norm_m": 0.07744878450925793, - "rotation_rpy_deg_xyz": [ - 0.4078265518810538, - -0.4045880920033579, - -0.48217921935507635 - ], - "rotation_angle_deg": 0.7490791613998786, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0005195250018715791, - -0.003915390368792071, - 0.00448967593256876 - ], - "translation_xyz_cm": [ - 0.05195250018715791, - -0.3915390368792071, - 0.448967593256876 - ], - "translation_norm_m": 0.0059797473146518945, - "rotation_rpy_deg_xyz": [ - 0.346594824257409, - -0.33914827388516566, - -0.4754163500468226 - ], - "rotation_angle_deg": 0.6783753930157004, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.00430747857871594, - 0.01282220408906587, - -0.06789370059700928 - ], - "translation_xyz_cm": [ - 0.430747857871594, - 1.282220408906587, - -6.789370059700928 - ], - "translation_norm_m": 0.0692280136228398, - "rotation_rpy_deg_xyz": [ - -0.48093996663388117, - -0.37691074111057254, - -0.3021567529035198 - ], - "rotation_angle_deg": 0.6823620158670933, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010184274050746955, - 0.01987258354891608, - -0.06236450892911398 - ], - "translation_xyz_cm": [ - 1.0184274050746955, - 1.9872583548916078, - -6.236450892911398 - ], - "translation_norm_m": 0.06624176166753798, - "rotation_rpy_deg_xyz": [ - 0.12344951262075038, - -0.009453270969454568, - 0.007163810121608981 - ], - "rotation_angle_deg": 0.1240185975242474, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012414396253178528, - 0.03890815549096027, - -0.11090791028095685 - ], - "translation_xyz_cm": [ - 1.2414396253178528, - 3.8908155490960272, - -11.090791028095685 - ], - "translation_norm_m": 0.11818852042786748, - "rotation_rpy_deg_xyz": [ - -0.7936129844267639, - -0.23233020797690354, - 0.1703297575998999 - ], - "rotation_angle_deg": 0.8439559383545983, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006518677743704959, - 0.015959886045983973, - -0.05250021745552304 - ], - "translation_xyz_cm": [ - 0.6518677743704959, - 1.5959886045983973, - -5.250021745552304 - ], - "translation_norm_m": 0.0552583383301043, - "rotation_rpy_deg_xyz": [ - -0.8645934388279924, - -0.10374963511312864, - 0.16706091542763948 - ], - "rotation_angle_deg": 0.8865285453010793, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0021804435424603863, - -0.01778573575765785, - -0.16715497210051045 - ], - "translation_xyz_cm": [ - -0.21804435424603863, - -1.778573575765785, - -16.715497210051044 - ], - "translation_norm_m": 0.168112674799985, - "rotation_rpy_deg_xyz": [ - -0.3621576055099488, - 1.5903982223275395, - -0.3309485894391467 - ], - "rotation_angle_deg": 1.6633426810172527, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0037935979256569774, - 0.011207583924450981, - -0.03480332892982078 - ], - "translation_xyz_cm": [ - -0.37935979256569774, - 1.1207583924450981, - -3.480332892982078 - ], - "translation_norm_m": 0.03675966576619625, - "rotation_rpy_deg_xyz": [ - 0.615404762728528, - 0.3560050697851942, - 0.20348406904038652 - ], - "rotation_angle_deg": 0.738978056043892, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.013283716917913413, - 0.01953700196067376, - -0.03616483570566817 - ], - "translation_xyz_cm": [ - 1.3283716917913413, - 1.953700196067376, - -3.616483570566817 - ], - "translation_norm_m": 0.04319776524757503, - "rotation_rpy_deg_xyz": [ - 0.8851650488468991, - 0.8692283649134583, - 0.19594078038254079 - ], - "rotation_angle_deg": 1.254918378434846, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.004890641425373765, - 0.0020739764108794745, - -0.025465593547015216 - ], - "translation_xyz_cm": [ - -0.4890641425373765, - 0.20739764108794745, - -2.5465593547015217 - ], - "translation_norm_m": 0.02601376955395449, - "rotation_rpy_deg_xyz": [ - -0.14698334332655463, - 2.3606610587543218, - 0.6477135066661399 - ], - "rotation_angle_deg": 2.453103621998225, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01585559623109556, - 0.01402512083567653, - -0.009454480321850325 - ], - "translation_xyz_cm": [ - 1.585559623109556, - 1.402512083567653, - -0.9454480321850325 - ], - "translation_norm_m": 0.023183855254359974, - "rotation_rpy_deg_xyz": [ - 0.42531613488117326, - 0.25254077525443025, - -0.011612030949835544 - ], - "rotation_angle_deg": 0.4947999311257519, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0006945444960360092, - 0.004321290862388194, - 0.011982555143209155 - ], - "translation_xyz_cm": [ - -0.06945444960360092, - 0.4321290862388194, - 1.1982555143209155 - ], - "translation_norm_m": 0.01275686382048432, - "rotation_rpy_deg_xyz": [ - 0.3354769208252955, - 1.7820811842419002, - 0.4875895658755844 - ], - "rotation_angle_deg": 1.8764288083424083, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.016701568835212233, - 0.003138013825199515, - 0.23406522185102213 - ], - "translation_xyz_cm": [ - 1.6701568835212233, - 0.3138013825199515, - 23.40652218510221 - ], - "translation_norm_m": 0.23468131074393778, - "rotation_rpy_deg_xyz": [ - 0.19226561184223334, - 0.10189052234262146, - -0.2786863514241317 - ], - "rotation_angle_deg": 0.35370751940467177, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0044840965280219525, - -0.010850748492544304, - 0.03180743625796156 - ], - "translation_xyz_cm": [ - 0.44840965280219525, - -1.0850748492544304, - 3.1807436257961563 - ], - "translation_norm_m": 0.033905145123201565, - "rotation_rpy_deg_xyz": [ - 0.5625757719133562, - 1.460110332130632, - 0.5254481995830794 - ], - "rotation_angle_deg": 1.6483149272435733, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.035346675034516495, - -0.012594154098606314, - 0.22528316943611654 - ], - "translation_xyz_cm": [ - 3.5346675034516495, - -1.2594154098606314, - 22.528316943611653 - ], - "translation_norm_m": 0.22838674783059798, - "rotation_rpy_deg_xyz": [ - 0.5716540713923016, - -0.19798278411781733, - -0.23679484600545556 - ], - "rotation_angle_deg": 0.6492986730858225, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03561696782899593, - 0.001193061215853941, - 0.32378401049570854 - ], - "translation_xyz_cm": [ - 3.5616967828995927, - 0.11930612158539411, - 32.378401049570854 - ], - "translation_norm_m": 0.3257392780201393, - "rotation_rpy_deg_xyz": [ - 0.11837770230309538, - 0.6767754688554426, - -0.2184401020168502 - ], - "rotation_angle_deg": 0.7211512309883626, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006846424959392472, - 0.011355869032236399, - 0.14827860983666563 - ], - "translation_xyz_cm": [ - 0.6846424959392472, - 1.1355869032236399, - 14.827860983666563 - ], - "translation_norm_m": 0.14887033093029656, - "rotation_rpy_deg_xyz": [ - 1.0739693926911786, - -1.482206698951081, - -0.7397167425024477 - ], - "rotation_angle_deg": 1.9689757378705774, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012499805509178952, - 0.02216538421772407, - 0.19946545117454884 - ], - "translation_xyz_cm": [ - -1.2499805509178952, - 2.216538421772407, - 19.946545117454882 - ], - "translation_norm_m": 0.20108211160506784, - "rotation_rpy_deg_xyz": [ - 1.0419323262277784, - -0.4032648831526395, - -0.6899044017939143 - ], - "rotation_angle_deg": 1.3111577676084054, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.002106439722939779, - -0.013093497832853629, - 0.10299136530511444 - ], - "translation_xyz_cm": [ - 0.2106439722939779, - -1.309349783285363, - 10.299136530511444 - ], - "translation_norm_m": 0.10384169731479186, - "rotation_rpy_deg_xyz": [ - -0.5796570700128448, - 0.6062420012796523, - 0.007792503277983368 - ], - "rotation_angle_deg": 0.8388307719398534, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00043435864222041154, - -0.00632415166044531, - -0.0503329049850736 - ], - "translation_xyz_cm": [ - 0.043435864222041154, - -0.632415166044531, - -5.03329049850736 - ], - "translation_norm_m": 0.05073051237559928, - "rotation_rpy_deg_xyz": [ - -0.27792170264485505, - 0.5935404576317737, - 0.09552138298618551 - ], - "rotation_angle_deg": 0.6625173986072784, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.00038087613815074306, - 0.02522581750565056, - 0.02820892317808868 - ], - "translation_xyz_cm": [ - -0.038087613815074306, - 2.522581750565056, - 2.820892317808868 - ], - "translation_norm_m": 0.03784481843434194, - "rotation_rpy_deg_xyz": [ - -0.6529823922251429, - -0.11504696282735678, - -0.7358061709119335 - ], - "rotation_angle_deg": 0.9909546407125354, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013744697864550126, - -0.043441115845159084, - -0.009900731492830123 - ], - "translation_xyz_cm": [ - 1.3744697864550126, - -4.344111584515908, - -0.9900731492830124 - ], - "translation_norm_m": 0.04662694231185891, - "rotation_rpy_deg_xyz": [ - 0.37236327460503577, - 0.06227225688750911, - -0.6400071781657749 - ], - "rotation_angle_deg": 0.7432354599498271, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.002074760319756397, - 0.010945385043760858, - 0.012640385795617298 - ], - "translation_xyz_cm": [ - 0.20747603197563969, - 1.0945385043760858, - 1.26403857956173 - ], - "translation_norm_m": 0.01684890017783544, - "rotation_rpy_deg_xyz": [ - 0.12182808172291339, - 0.11594233654150342, - 0.1481269168367565 - ], - "rotation_angle_deg": 0.22403069452946567, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.005837871624343016, - -0.013783818384081992, - 0.0014922663557854488 - ], - "translation_xyz_cm": [ - 0.5837871624343016, - -1.3783818384081992, - 0.14922663557854488 - ], - "translation_norm_m": 0.015043312574837871, - "rotation_rpy_deg_xyz": [ - -1.1953604085028229, - -1.0429171941128337, - 0.15533336214253 - ], - "rotation_angle_deg": 1.5928811760259691, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.0052626196896492505, - -0.000542177021255863, - 0.061255363277643006 - ], - "translation_xyz_cm": [ - 0.526261968964925, - -0.0542177021255863, - 6.1255363277643005 - ], - "translation_norm_m": 0.061483401436455004, - "rotation_rpy_deg_xyz": [ - 0.007477904378911511, - -0.30884380613354123, - -0.12914460637116182 - ], - "rotation_angle_deg": 0.3348335389911787, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.005340469899470346, - -0.032338693895048065, - 0.0102952683994907 - ], - "translation_xyz_cm": [ - -0.5340469899470346, - -3.2338693895048065, - 1.02952683994907 - ], - "translation_norm_m": 0.034355556945017206, - "rotation_rpy_deg_xyz": [ - 1.3177875359502709, - 0.2397427355720673, - -0.18667791105911688 - ], - "rotation_angle_deg": 1.352743300230035, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.012381646386875556, - 0.019075422433856737, - 0.03268105504500258 - ], - "translation_xyz_cm": [ - -1.2381646386875556, - 1.9075422433856737, - 3.268105504500258 - ], - "translation_norm_m": 0.03981492518056767, - "rotation_rpy_deg_xyz": [ - 0.32811089070650684, - 1.0938943591736778, - -0.27732945476011156 - ], - "rotation_angle_deg": 1.1759696908666009, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0008881229455779405, - -0.034121417668073306, - -0.05559411589156823 - ], - "translation_xyz_cm": [ - 0.08881229455779405, - -3.4121417668073306, - -5.559411589156823 - ], - "translation_norm_m": 0.06523622941135306, - "rotation_rpy_deg_xyz": [ - 0.8903794626595006, - 0.3659796465573089, - -0.07450550998247009 - ], - "rotation_angle_deg": 0.9657580817962326, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.018536314228892792, - 0.006235894981081458, - -0.1228577209282559 - ], - "translation_xyz_cm": [ - 1.8536314228892792, - 0.6235894981081458, - -12.28577209282559 - ], - "translation_norm_m": 0.12440458561923085, - "rotation_rpy_deg_xyz": [ - 0.4229315732726078, - 1.0815575509715794, - -0.015532767442951432 - ], - "rotation_angle_deg": 1.1614636480675928, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.006720626406270247, - 0.020830328035098766, - -0.12184231635171613 - ], - "translation_xyz_cm": [ - 0.6720626406270247, - 2.0830328035098766, - -12.184231635171614 - ], - "translation_norm_m": 0.12379264695164309, - "rotation_rpy_deg_xyz": [ - 0.17435176344098524, - 1.5183208042313727, - 0.22799608320301332 - ], - "rotation_angle_deg": 1.5448691050288041, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019864080627680858, - 0.015488953495032542, - -0.03693327955855756 - ], - "translation_xyz_cm": [ - -1.9864080627680858, - 1.5488953495032542, - -3.693327955855756 - ], - "translation_norm_m": 0.04470521802323363, - "rotation_rpy_deg_xyz": [ - 0.3137728508955134, - 0.04832975926921964, - 0.08003547279851742 - ], - "rotation_angle_deg": 0.327373852272857, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.031733973655696746, - 0.01896362797171325, - -0.06932380335701871 - ], - "translation_xyz_cm": [ - -3.1733973655696746, - 1.8963627971713248, - -6.932380335701871 - ], - "translation_norm_m": 0.07856496663088834, - "rotation_rpy_deg_xyz": [ - 0.648384294535184, - 0.7573749471695294, - 0.33168223178732675 - ], - "rotation_angle_deg": 1.049371445715633, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009781342011499106, - 0.011927514108743709, - -0.03634209926234475 - ], - "translation_xyz_cm": [ - -0.9781342011499106, - 1.1927514108743709, - -3.634209926234475 - ], - "translation_norm_m": 0.039480228256107086, - "rotation_rpy_deg_xyz": [ - 0.5481734068618089, - 0.609832612465558, - 0.2503689284770325 - ], - "rotation_angle_deg": 0.8565102494815371, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.009317218084279544, - -0.004294537073065374, - 0.06000729144536707 - ], - "translation_xyz_cm": [ - 0.9317218084279544, - -0.4294537073065374, - 6.000729144536707 - ], - "translation_norm_m": 0.060877981472049335, - "rotation_rpy_deg_xyz": [ - 1.7460832343704367, - 0.010574718333253618, - -0.2604472046921517 - ], - "rotation_angle_deg": 1.7654545891487659, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007999542677307403, - 0.005577214123312801, - 0.013980144067582079 - ], - "translation_xyz_cm": [ - -0.7999542677307403, - 0.5577214123312801, - 1.3980144067582079 - ], - "translation_norm_m": 0.017045305176901136, - "rotation_rpy_deg_xyz": [ - 1.6752646779127547, - 0.5341344758512746, - 0.4235966245176509 - ], - "rotation_angle_deg": 1.8068191808797784, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.02057237918682464, - 0.014652073163449852, - 0.09008317396869707 - ], - "translation_xyz_cm": [ - 2.057237918682464, - 1.4652073163449852, - 9.008317396869707 - ], - "translation_norm_m": 0.09355685044756543, - "rotation_rpy_deg_xyz": [ - 2.313416626502316, - -0.35494823522324065, - -0.49308450900475187 - ], - "rotation_angle_deg": 2.3903764199327346, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0059922869404802626, - 0.0063873027760019685, - 0.03196752834277708 - ], - "translation_xyz_cm": [ - 0.5992286940480263, - 0.6387302776001968, - 3.196752834277708 - ], - "translation_norm_m": 0.03314555789054739, - "rotation_rpy_deg_xyz": [ - 2.089168632880967, - 0.4852020062560545, - 0.21350546174592167 - ], - "rotation_angle_deg": 2.154488902325351, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011099429758935297, - 0.006233920545627214, - 0.013730358832632558 - ], - "translation_xyz_cm": [ - 1.1099429758935297, - 0.6233920545627214, - 1.3730358832632559 - ], - "translation_norm_m": 0.018723831339113865, - "rotation_rpy_deg_xyz": [ - 1.1977673918356821, - 1.1810234990325177, - -0.48064029119017715 - ], - "rotation_angle_deg": 1.7527913715890677, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.001427186960198945, - -0.017181913808577753, - 0.014892251493493533 - ], - "translation_xyz_cm": [ - -0.1427186960198945, - -1.7181913808577753, - 1.4892251493493533 - ], - "translation_norm_m": 0.022782321639600676, - "rotation_rpy_deg_xyz": [ - -0.5827069464529321, - -0.308234946756496, - -0.6957665788685778 - ], - "rotation_angle_deg": 0.959594825027969, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.004342275640175863, - 0.04140047533558422, - 0.07036478968176531 - ], - "translation_xyz_cm": [ - -0.43422756401758633, - 4.1400475335584215, - 7.036478968176531 - ], - "translation_norm_m": 0.08175609055420059, - "rotation_rpy_deg_xyz": [ - -1.3647734339067032, - -0.42939472322973293, - 0.6075044915950952 - ], - "rotation_angle_deg": 1.5523551637824822, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.026037366631039838, - 0.025124582648961002, - 0.04828281754733797 - ], - "translation_xyz_cm": [ - 2.6037366631039838, - 2.5124582648961002, - 4.828281754733797 - ], - "translation_norm_m": 0.06033588968991165, - "rotation_rpy_deg_xyz": [ - -0.535540312693118, - 0.09678330005098018, - 0.4918452634142074 - ], - "rotation_angle_deg": 0.733842794348025, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006905779478217466, - -0.023979684016449287, - 0.02249231854806271 - ], - "translation_xyz_cm": [ - -0.6905779478217466, - -2.3979684016449285, - 2.249231854806271 - ], - "translation_norm_m": 0.033594931602818436, - "rotation_rpy_deg_xyz": [ - 0.6524079579019757, - -0.5188491168754197, - -0.1252082566286941 - ], - "rotation_angle_deg": 0.8424813032456042, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0024781986277098156, - 0.0011625194842148634, - 0.031866134386988335 - ], - "translation_xyz_cm": [ - -0.24781986277098156, - 0.11625194842148634, - 3.1866134386988336 - ], - "translation_norm_m": 0.03198348700125054, - "rotation_rpy_deg_xyz": [ - 0.3500676267360066, - -1.118280813117824, - 0.23577309223122908 - ], - "rotation_angle_deg": 1.1959487301344318, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.010170602558004838, - 0.007522471915827944, - 0.026536495305336125 - ], - "translation_xyz_cm": [ - -1.0170602558004838, - 0.7522471915827944, - 2.6536495305336123 - ], - "translation_norm_m": 0.029397522399131543, - "rotation_rpy_deg_xyz": [ - -0.8260664722887483, - -0.8832432827622727, - 0.1731945725786607 - ], - "rotation_angle_deg": 1.2207705543911835, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01251905151535615, - 0.01733507577041371, - -0.046430013676781096 - ], - "translation_xyz_cm": [ - 1.251905151535615, - 1.733507577041371, - -4.643001367678109 - ], - "translation_norm_m": 0.05111729328550374, - "rotation_rpy_deg_xyz": [ - -0.2376027461970587, - -0.09662326193737912, - 0.0943577638515474 - ], - "rotation_angle_deg": 0.27323372908576454, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0029162396891575515, - 0.0046343371519921295, - -0.024804725222151207 - ], - "translation_xyz_cm": [ - -0.29162396891575515, - 0.46343371519921295, - -2.4804725222151207 - ], - "translation_norm_m": 0.025401888278420888, - "rotation_rpy_deg_xyz": [ - -0.08530996634165378, - -0.023160215819794987, - -0.05055491465550929 - ], - "rotation_angle_deg": 0.10184168148608404, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0145750099555213, - 0.023017543984789945, - -0.029084809744800086 - ], - "translation_xyz_cm": [ - 1.45750099555213, - 2.3017543984789945, - -2.9084809744800086 - ], - "translation_norm_m": 0.03985178043935431, - "rotation_rpy_deg_xyz": [ - 0.8354650123961268, - 0.5627588542291962, - -0.1374332258214981 - ], - "rotation_angle_deg": 1.0172064079567749, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0165245320233125, - 0.013286485311736373, - -0.037810734839921686 - ], - "translation_xyz_cm": [ - 1.65245320233125, - 1.3286485311736373, - -3.7810734839921687 - ], - "translation_norm_m": 0.04335023090668993, - "rotation_rpy_deg_xyz": [ - 0.8253977382847336, - 0.33556692276050415, - -0.07962983462481771 - ], - "rotation_angle_deg": 0.8947683295914634, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004726190427944754, - 0.0031154019323061943, - 0.017620733093272334 - ], - "translation_xyz_cm": [ - 0.4726190427944754, - 0.31154019323061943, - 1.7620733093272334 - ], - "translation_norm_m": 0.01850764274307662, - "rotation_rpy_deg_xyz": [ - 1.0931367712721838, - -0.07003121661570053, - 0.021372931860724517 - ], - "rotation_angle_deg": 1.095599182282767, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.13355412573715597, - "improved_pairs": 28, - "worsened_pairs": 38, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07166839723602836, - "global_consistency_signal": false - } - }, - { - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977515508234834, - -0.004597357058808013, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150315, - 1.2026608220810582, - -1.035510052785851 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10053142254152782, - "median": 0.05554308417185303, - "p90": 0.1588767029058682, - "p95": 0.21936106228007995, - "max": 0.3324257904109372 - }, - "rotation_deg": { - "rms": 1.0152957563636194, - "median": 0.8242769110324839, - "p90": 1.539611636411224, - "p95": 1.7217363975309565, - "max": 2.182305990196691 - }, - "normalized_pair_score": { - "rms": 2.8576089058597884, - "median": 2.412009941338595, - "p90": 4.395172056188768, - "p95": 4.906500775589421, - "max": 6.699738172693263 - }, - "normalized_global_rms": 2.8576089058597884 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.011748910217794173, - 0.012585336235598654, - 0.0774522090436308 - ], - "translation_xyz_cm": [ - -1.1748910217794173, - 1.2585336235598654, - 7.74522090436308 - ], - "translation_norm_m": 0.07934275181267124, - "rotation_rpy_deg_xyz": [ - -0.5355339443982134, - -0.10930893417334092, - 0.02466830083713769 - ], - "rotation_angle_deg": 0.5471090190705757, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.752893333210111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570956, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.011748910217794173, - 0.012585336235598654, - 0.0774522090436308 - ], - "translation_xyz_cm": [ - -1.1748910217794173, - 1.2585336235598654, - 7.74522090436308 - ], - "translation_norm_m": 0.07934275181267124, - "rotation_rpy_deg_xyz": [ - -0.5355339443982134, - -0.10930893417334092, - 0.02466830083713769 - ], - "rotation_angle_deg": 0.5471090190705757, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02209223460543952, - -0.018020726700241907, - 0.13305462993191253 - ], - "translation_xyz_cm": [ - 2.209223460543952, - -1.8020726700241907, - 13.305462993191252 - ], - "translation_norm_m": 0.13607478813867316, - "rotation_rpy_deg_xyz": [ - -0.31914652144259936, - -0.21122341614483142, - -0.34646275641837543 - ], - "rotation_angle_deg": 0.5166365681634414, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.034782737187538104, - 0.006203266958609177, - 0.10972025668372652 - ], - "translation_xyz_cm": [ - 3.4782737187538104, - 0.6203266958609177, - 10.972025668372652 - ], - "translation_norm_m": 0.1152686169517096, - "rotation_rpy_deg_xyz": [ - -0.27833863014259475, - -0.2946203532968976, - -0.4025139229771166 - ], - "rotation_angle_deg": 0.5717221816616094, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.034811865315541035, - -0.02063602145204535, - 0.0483641294919513 - ], - "translation_xyz_cm": [ - 3.4811865315541035, - -2.063602145204535, - 4.83641294919513 - ], - "translation_norm_m": 0.06306187730817152, - "rotation_rpy_deg_xyz": [ - 0.25301234431144376, - 0.07856507161125245, - -0.35150133642727194 - ], - "rotation_angle_deg": 0.4402983357286551, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04646087619157224, - 0.010172194661397183, - 0.02634250593874724 - ], - "translation_xyz_cm": [ - 4.646087619157225, - 1.0172194661397183, - 2.634250593874724 - ], - "translation_norm_m": 0.054369239279678135, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940171 - ], - "rotation_angle_deg": 0.5821611725015248, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.012274334959605893, - 0.00793477278401089, - -0.029521317730994805 - ], - "translation_xyz_cm": [ - 1.2274334959605893, - 0.7934772784010891, - -2.9521317730994805 - ], - "translation_norm_m": 0.032941282889541984, - "rotation_rpy_deg_xyz": [ - 0.49350043746978545, - 0.09079480892185002, - 0.12920228121145672 - ], - "rotation_angle_deg": 0.5180525169080188, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.0047454701110814235, - 0.02112711836433176, - -0.009517598854441556 - ], - "translation_xyz_cm": [ - 0.47454701110814235, - 2.112711836433176, - -0.9517598854441556 - ], - "translation_norm_m": 0.023652892104554967, - "rotation_rpy_deg_xyz": [ - 0.2526567759620954, - 0.20523572243396423, - -0.034578606886677916 - ], - "rotation_angle_deg": 0.3273897544800289, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03547722980418585, - -0.00023510086484124226, - -0.07014046073675319 - ], - "translation_xyz_cm": [ - -3.547722980418585, - -0.023510086484124226, - -7.014046073675319 - ], - "translation_norm_m": 0.07860262934126108, - "rotation_rpy_deg_xyz": [ - 0.5232134708787115, - 0.45218792670014574, - 0.5310776539185691 - ], - "rotation_angle_deg": 0.8706732532310362, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03400394410147545, - -0.017996844189704708, - -0.12735147486993081 - ], - "translation_xyz_cm": [ - -3.4003944101475447, - -1.7996844189704708, - -12.735147486993082 - ], - "translation_norm_m": 0.13303590780985183, - "rotation_rpy_deg_xyz": [ - 0.6042176970972334, - 0.22227025318415516, - 0.3942421887159937 - ], - "rotation_angle_deg": 0.7543101544010228, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.033518858483133754, - -0.020542953718810042, - -0.05028630971691779 - ], - "translation_xyz_cm": [ - -3.3518858483133753, - -2.054295371881004, - -5.028630971691779 - ], - "translation_norm_m": 0.06382977178755458, - "rotation_rpy_deg_xyz": [ - 0.4463900452974913, - 0.318991530825338, - 0.5838735792541094 - ], - "rotation_angle_deg": 0.8002960897011372, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04099366374647419, - -0.03844922721926747, - -0.07566593743095464 - ], - "translation_xyz_cm": [ - -4.099366374647419, - -3.844922721926747, - -7.5665937430954635 - ], - "translation_norm_m": 0.09425580952080881, - "rotation_rpy_deg_xyz": [ - 0.5870852895990375, - 0.7143924390784686, - 0.4978279478250881 - ], - "rotation_angle_deg": 1.0484294819479305, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.014134104373278597, - -0.009970248604019571, - -0.030147293449747342 - ], - "translation_xyz_cm": [ - -1.4134104373278598, - -0.9970248604019571, - -3.014729344974734 - ], - "translation_norm_m": 0.034756842002775026, - "rotation_rpy_deg_xyz": [ - 0.30474184819580336, - 0.25845828464587195, - -0.08851206912855256 - ], - "rotation_angle_deg": 0.40941928556312285, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.006177434996041731, - -0.0058268135832307555, - -0.21048436620985722 - ], - "translation_xyz_cm": [ - 0.6177434996041731, - -0.5826813583230755, - -21.048436620985722 - ], - "translation_norm_m": 0.21065559778564946, - "rotation_rpy_deg_xyz": [ - -0.10886326738779831, - -0.05166856778838729, - 0.2911260770113835 - ], - "rotation_angle_deg": 0.3150343350961785, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.005018049906427735, - 0.014779253068970679, - -0.19504332819115258 - ], - "translation_xyz_cm": [ - 0.5018049906427735, - 1.477925306897068, - -19.50433281911526 - ], - "translation_norm_m": 0.19566682656501008, - "rotation_rpy_deg_xyz": [ - 0.008783200158708518, - -0.22556277911163353, - 0.39543493496895893 - ], - "rotation_angle_deg": 0.4553437938897104, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.012739039831569654, - 0.005306737252583349, - -0.1322742186952278 - ], - "translation_xyz_cm": [ - -1.2739039831569654, - 0.5306737252583349, - -13.227421869522779 - ], - "translation_norm_m": 0.13299215588722224, - "rotation_rpy_deg_xyz": [ - 0.41824380852496823, - -0.5183159728890546, - -0.1006787201382111 - ], - "rotation_angle_deg": 0.6733003074377573, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.009084596052393312, - 0.011008964553714806, - -0.13038656635979554 - ], - "translation_xyz_cm": [ - 0.9084596052393312, - 1.1008964553714806, - -13.038656635979553 - ], - "translation_norm_m": 0.13116548278063658, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.29041448129309333 - ], - "rotation_angle_deg": 1.106582027992288, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009871890828461571, - -0.0014957793035517142, - -0.05615069708980904 - ], - "translation_xyz_cm": [ - -0.9871890828461571, - -0.14957793035517142, - -5.615069708980904 - ], - "translation_norm_m": 0.05703150329357878, - "rotation_rpy_deg_xyz": [ - -0.8100617809077636, - 0.1347822057482451, - -0.21350123200693003 - ], - "rotation_angle_deg": 0.8482577323638306, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.011156508412904609, - -0.015244501202385147, - 0.06810370903294502 - ], - "translation_xyz_cm": [ - -1.1156508412904609, - -1.5244501202385148, - 6.810370903294502 - ], - "translation_norm_m": 0.07067515603747027, - "rotation_rpy_deg_xyz": [ - 0.2506843576111673, - -0.39577345967054717, - -0.4857289455081575 - ], - "rotation_angle_deg": 0.67421749256899, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.0016665222487272091, - 0.000302369273450509, - 0.0014459179335448193 - ], - "translation_xyz_cm": [ - -0.1666522248727209, - 0.0302369273450509, - 0.1445917933544819 - ], - "translation_norm_m": 0.0022269715430548957, - "rotation_rpy_deg_xyz": [ - 0.11964371567764986, - -0.35285794691723626, - -0.48101201637706753 - ], - "rotation_angle_deg": 0.608145233254483, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.0021093383660201193, - 0.015705360038618776, - -0.06703348713894236 - ], - "translation_xyz_cm": [ - 0.21093383660201193, - 1.5705360038618776, - -6.703348713894236 - ], - "translation_norm_m": 0.0688810281593688, - "rotation_rpy_deg_xyz": [ - -0.7824538874847704, - -0.43842269799839084, - -0.3093948954996361 - ], - "rotation_angle_deg": 0.9497479873876222, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.010691310859906933, - 0.019432172695561523, - -0.0606605333230603 - ], - "translation_xyz_cm": [ - 1.0691310859906933, - 1.9432172695561523, - -6.06605333230603 - ], - "translation_norm_m": 0.06458803114054028, - "rotation_rpy_deg_xyz": [ - 0.05141503904963398, - 0.00449354092149435, - 0.005662578035081809 - ], - "rotation_angle_deg": 0.051920517173624496, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014054342035886513, - 0.03834393454603746, - -0.10654760316415678 - ], - "translation_xyz_cm": [ - 1.4054342035886513, - 3.834393454603746, - -10.654760316415677 - ], - "translation_norm_m": 0.11410597524476587, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.16652151636587267 - ], - "rotation_angle_deg": 0.9937108406424441, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0075852997877216555, - 0.015708647987240587, - -0.050730680236009656 - ], - "translation_xyz_cm": [ - 0.7585299787721655, - 1.5708647987240587, - -5.073068023600966 - ], - "translation_norm_m": 0.05364606520207152, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.1649544244010011 - ], - "rotation_angle_deg": 0.970054673754125, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0020806016522596504, - -0.021621418126227532, - -0.1555936675834115 - ], - "translation_xyz_cm": [ - 0.20806016522596504, - -2.162141812622753, - -15.55936675834115 - ], - "translation_norm_m": 0.15710252708687314, - "rotation_rpy_deg_xyz": [ - -0.5624711770128453, - 1.5874171543552886, - -0.33569411857993225 - ], - "rotation_angle_deg": 1.7157208115256655, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.0020691642430539225, - 0.011131937774707112, - -0.03279092164813225 - ], - "translation_xyz_cm": [ - -0.20691642430539225, - 1.1131937774707112, - -3.279092164813225 - ], - "translation_norm_m": 0.03469071953446098, - "rotation_rpy_deg_xyz": [ - 0.5054479062183199, - 0.37053727338806464, - 0.20121515514486524 - ], - "rotation_angle_deg": 0.657726366657615, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01646526990365227, - 0.015907898886068805, - -0.024997057111626572 - ], - "translation_xyz_cm": [ - 1.6465269903652269, - 1.5907898886068805, - -2.4997057111626573 - ], - "translation_norm_m": 0.03389718608102193, - "rotation_rpy_deg_xyz": [ - 0.6631716668254954, - 0.8578341641824542, - 0.19039500522721647 - ], - "rotation_angle_deg": 1.100012107447725, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005749609255651489, - 0.00981813121814712, - -0.011528589843174137 - ], - "translation_xyz_cm": [ - -0.5749609255651489, - 0.9818131218147119, - -1.1528589843174137 - ], - "translation_norm_m": 0.016197595222179315, - "rotation_rpy_deg_xyz": [ - -0.5552161207845999, - 2.009421266253433, - 0.6357031086241702 - ], - "rotation_angle_deg": 2.182305990196691, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01730742819920117, - 0.009930629965015925, - -0.0012538299766535616 - ], - "translation_xyz_cm": [ - 1.730742819920117, - 0.9930629965015925, - -0.12538299766535616 - ], - "translation_norm_m": 0.019993413214929836, - "rotation_rpy_deg_xyz": [ - 0.31124513246765945, - 0.2668531437532043, - -0.014031036738193366 - ], - "rotation_angle_deg": 0.410245251568496, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.001417177958336513, - 0.010278608573110137, - 0.02064514149799443 - ], - "translation_xyz_cm": [ - -0.1417177958336513, - 1.0278608573110137, - 2.064514149799443 - ], - "translation_norm_m": 0.023105844607739828, - "rotation_rpy_deg_xyz": [ - -0.07069970480496512, - 1.5418459142259642, - 0.47434907172896096 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.014508837017172538, - 0.00379210170019606, - 0.24608409874515946 - ], - "translation_xyz_cm": [ - 1.4508837017172538, - 0.379210170019606, - 24.608409874515946 - ], - "translation_norm_m": 0.24654060526029561, - "rotation_rpy_deg_xyz": [ - -0.19311360273658235, - -0.3257197603704734, - -0.2932923739515135 - ], - "rotation_angle_deg": 0.47929971160952933, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.00040765859320579523, - -0.005370934206996636, - 0.02979232131826145 - ], - "translation_xyz_cm": [ - -0.04076585932057952, - -0.5370934206996636, - 2.9792321318261448 - ], - "translation_norm_m": 0.030275328723484353, - "rotation_rpy_deg_xyz": [ - 0.198825597238105, - 1.3268006810040451, - 0.5142543825749741 - ], - "rotation_angle_deg": 1.43596923674241, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.030619780130571983, - -0.014642186475313679, - 0.23067352639628064 - ], - "translation_xyz_cm": [ - 3.0619780130571983, - -1.4642186475313679, - 23.067352639628062 - ], - "translation_norm_m": 0.2331571151393798, - "rotation_rpy_deg_xyz": [ - 0.16034369761383052, - -0.5134999386071942, - -0.25259308482191417 - ], - "rotation_angle_deg": 0.5939965715201474, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03395811086541589, - -0.006118990331226648, - 0.33063017223797775 - ], - "translation_xyz_cm": [ - 3.395811086541589, - -0.6118990331226648, - 33.06301722379777 - ], - "translation_norm_m": 0.3324257904109372, - "rotation_rpy_deg_xyz": [ - -0.2563013940830722, - 0.22672202245265619, - -0.2325405141945881 - ], - "rotation_angle_deg": 0.41343957554542377, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009800785582382732, - 0.006496368501754279, - 0.16021999448673158 - ], - "translation_xyz_cm": [ - 0.9800785582382732, - 0.6496368501754279, - 16.021999448673157 - ], - "translation_norm_m": 0.16065087872486325, - "rotation_rpy_deg_xyz": [ - 0.8856777756756926, - -1.4812056342085482, - -0.7441413425210676 - ], - "rotation_angle_deg": 1.8748380811355037, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.005669142096515589, - 0.015348355392785784, - 0.22165982567898568 - ], - "translation_xyz_cm": [ - -0.5669142096515589, - 1.5348355392785784, - 22.165982567898567 - ], - "translation_norm_m": 0.22226288377822345, - "rotation_rpy_deg_xyz": [ - 0.7326830017201675, - -0.4714411171372534, - -0.6991490251757558 - ], - "rotation_angle_deg": 1.1151964340680316, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0045640458821787355, - -0.01703721302446559, - 0.11212040617203739 - ], - "translation_xyz_cm": [ - 0.45640458821787355, - -1.7037213024465592, - 11.212040617203739 - ], - "translation_norm_m": 0.11349926265239917, - "rotation_rpy_deg_xyz": [ - -0.718534259765166, - 0.6180768996940113, - 0.004530359058897863 - ], - "rotation_angle_deg": 0.9478191646739258, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0065056973829920595, - -0.00651425315022891, - -0.04070987050354279 - ], - "translation_xyz_cm": [ - 0.650569738299206, - -0.651425315022891, - -4.0709870503542795 - ], - "translation_norm_m": 0.041737910213133105, - "rotation_rpy_deg_xyz": [ - -0.5190787323237712, - 0.5728926682292592, - 0.08970289125554257 - ], - "rotation_angle_deg": 0.7785618518380146, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.003047158440480313, - 0.01612423201090185, - 0.047277027296241496 - ], - "translation_xyz_cm": [ - 0.3047158440480313, - 1.612423201090185, - 4.727702729624149 - ], - "translation_norm_m": 0.050043914140206355, - "rotation_rpy_deg_xyz": [ - -0.8380523330945313, - -0.11317732429063847, - -0.7401789685625001 - ], - "rotation_angle_deg": 1.124375763416719, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01506677562722869, - -0.03303247254013719, - -0.01681280025847893 - ], - "translation_xyz_cm": [ - 1.506677562722869, - -3.303247254013719, - -1.6812800258478928 - ], - "translation_norm_m": 0.04001027646052548, - "rotation_rpy_deg_xyz": [ - 0.10326906176616632, - 0.025313967913603432, - -0.6469944518488367 - ], - "rotation_angle_deg": 0.6556954445211132, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.004301167868860922, - 0.02315246656537262, - 0.0017386993148900132 - ], - "translation_xyz_cm": [ - 0.43011678688609223, - 2.315246656537262, - 0.17386993148900132 - ], - "translation_norm_m": 0.02361270480915767, - "rotation_rpy_deg_xyz": [ - -0.11264639000956143, - 0.09867563901568227, - 0.14236359183674593 - ], - "rotation_angle_deg": 0.20669080105969642, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.002681014467468934, - 0.0015153298205303756, - -0.021051384127350137 - ], - "translation_xyz_cm": [ - 0.2681014467468934, - 0.15153298205303756, - -2.1051384127350135 - ], - "translation_norm_m": 0.021275451504422078, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.15117668573593138 - ], - "rotation_angle_deg": 1.7237415928660536, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - -0.0007294237001627124, - 0.0059449168002362884, - 0.056399786770500164 - ], - "translation_xyz_cm": [ - -0.07294237001627124, - 0.5944916800236288, - 5.639978677050016 - ], - "translation_norm_m": 0.05671692906402793, - "rotation_rpy_deg_xyz": [ - -0.35502558456679695, - -0.4408120377458715, - -0.13900903227030736 - ], - "rotation_angle_deg": 0.5831473606925559, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01560892776380296, - -0.02711371383790917, - 0.023855427044536623 - ], - "translation_xyz_cm": [ - -1.560892776380296, - -2.711371383790917, - 2.385542704453662 - ], - "translation_norm_m": 0.03934302356831329, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.2120103820291368 - ], - "rotation_angle_deg": 1.1246915495033547, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0048724388638325955, - 0.016555725748206296, - 0.04570196729823925 - ], - "translation_xyz_cm": [ - -0.48724388638325955, - 1.6555725748206296, - 4.570196729823925 - ], - "translation_norm_m": 0.048851842651643516, - "rotation_rpy_deg_xyz": [ - 0.09546623284033684, - 1.0775827775049782, - -0.28309517022880515 - ], - "rotation_angle_deg": 1.118457401217174, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0028301573949613967, - -0.022330318830221074, - -0.0556838307011613 - ], - "translation_xyz_cm": [ - -0.2830157394961397, - -2.2330318830221074, - -5.56838307011613 - ], - "translation_norm_m": 0.06006115159980846, - "rotation_rpy_deg_xyz": [ - 0.49268288279378014, - 0.15825199914177118, - -0.08908409912480704 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0022757930111132474, - 0.014543032548259838, - -0.11953391143381428 - ], - "translation_xyz_cm": [ - -0.22757930111132474, - 1.4543032548259838, - -11.953391143381427 - ], - "translation_norm_m": 0.12043685072350628, - "rotation_rpy_deg_xyz": [ - 0.12223918632624664, - 0.5394939332637073, - -0.03218937106782452 - ], - "rotation_angle_deg": 0.554138258694884, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.014126014428800016, - 0.01731979971752029, - -0.11961246320644903 - ], - "translation_xyz_cm": [ - -1.4126014428800016, - 1.731979971752029, - -11.961246320644904 - ], - "translation_norm_m": 0.12168262447947038, - "rotation_rpy_deg_xyz": [ - 0.0276493173995964, - 0.9049016731683907, - 0.21555739065093418 - ], - "rotation_angle_deg": 0.9305812158627091, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.02853954413988813, - 0.022752825419550704, - -0.04726765181828505 - ], - "translation_xyz_cm": [ - -2.853954413988813, - 2.2752825419550704, - -4.7267651818285055 - ], - "translation_norm_m": 0.05971957428431487, - "rotation_rpy_deg_xyz": [ - -0.02108664689711348, - -0.04627392585907875, - 0.07066423048105784 - ], - "rotation_angle_deg": 0.08705258513789994, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.04181611136879804, - 0.020626640433104915, - -0.07395128074428872 - ], - "translation_xyz_cm": [ - -4.181611136879804, - 2.0626640433104915, - -7.3951280744288725 - ], - "translation_norm_m": 0.08742332291376785, - "rotation_rpy_deg_xyz": [ - 0.24098676691704196, - 0.5093600460816013, - 0.316941031122525 - ], - "rotation_angle_deg": 0.6459827373704318, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008705213993577876, - 0.012057603039119735, - -0.03315699913695252 - ], - "translation_xyz_cm": [ - -0.8705213993577876, - 1.2057603039119735, - -3.315699913695252 - ], - "translation_norm_m": 0.03633941570101043, - "rotation_rpy_deg_xyz": [ - 0.37854407785868566, - 0.6159343431432545, - 0.2464891649407497 - ], - "rotation_angle_deg": 0.7631660358041191, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00712107026679365, - -0.011127561567771949, - 0.04433844629578218 - ], - "translation_xyz_cm": [ - -0.712107026679365, - -1.1127561567771949, - 4.433844629578218 - ], - "translation_norm_m": 0.04626478237399511, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435075824, - -0.28505939336063874 - ], - "rotation_angle_deg": 1.4218618784137353, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.02157445571594785, - 0.012375879779870536, - 0.01887161887767151 - ], - "translation_xyz_cm": [ - -2.157445571594785, - 1.2375879779870536, - 1.8871618877671512 - ], - "translation_norm_m": 0.031221107264626135, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.396052252285909 - ], - "rotation_angle_deg": 1.3889476012857715, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0043192737444002205, - 0.006686296338488162, - 0.07897205914858062 - ], - "translation_xyz_cm": [ - 0.43192737444002205, - 0.6686296338488162, - 7.897205914858062 - ], - "translation_norm_m": 0.07937221686819677, - "rotation_rpy_deg_xyz": [ - 1.9153211457929256, - -0.5642927668743174, - -0.5129336418772029 - ], - "rotation_angle_deg": 2.0591868076103896, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.006700159996405386, - 0.012759275287178351, - 0.026413834674712214 - ], - "translation_xyz_cm": [ - -0.6700159996405386, - 1.275927528717835, - 2.6413834674712215 - ], - "translation_norm_m": 0.030089564836575163, - "rotation_rpy_deg_xyz": [ - 1.6796519267758923, - 0.14604200808447562, - 0.18829326127872464 - ], - "rotation_angle_deg": 1.6962319982758776, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.00416672114207417, - 0.011585463148090946, - 0.01381971771250444 - ], - "translation_xyz_cm": [ - -0.416672114207417, - 1.1585463148090946, - 1.381971771250444 - ], - "translation_norm_m": 0.018508622830586022, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781138 - ], - "rotation_angle_deg": 1.2068669805108514, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0021140550844855888, - -0.011122111731391326, - 0.008040120808944284 - ], - "translation_xyz_cm": [ - -0.21140550844855888, - -1.1122111731391326, - 0.8040120808944284 - ], - "translation_norm_m": 0.01388575316243994, - "rotation_rpy_deg_xyz": [ - -0.7428475785243821, - -0.3000926755847766, - -0.699539870012595 - ], - "rotation_angle_deg": 1.0648693173338326, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005822859443569861, - 0.05539872553156422, - 0.05584562954024054 - ], - "translation_xyz_cm": [ - -0.5822859443569861, - 5.539872553156422, - 5.5845629540240544 - ], - "translation_norm_m": 0.07887749248909313, - "rotation_rpy_deg_xyz": [ - -1.2295910627015747, - -0.5146874739254865, - 0.6115327195593028 - ], - "rotation_angle_deg": 1.4642363140494419, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.035159258025379, - 0.03980201884486867, - 0.036218321770759135 - ], - "translation_xyz_cm": [ - 3.5159258025379003, - 3.980201884486867, - 3.6218321770759134 - ], - "translation_norm_m": 0.06428173115989258, - "rotation_rpy_deg_xyz": [ - -0.31513998336533705, - -0.2141940157510921, - 0.4953590423367671 - ], - "rotation_angle_deg": 0.6244903967618446, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006551094106074018, - -0.02065967419229031, - 0.019057592907733324 - ], - "translation_xyz_cm": [ - -0.6551094106074018, - -2.065967419229031, - 1.9057592907733325 - ], - "translation_norm_m": 0.028860540867334965, - "rotation_rpy_deg_xyz": [ - 0.8370618070321812, - -0.6739925190910833, - -0.12485818713744735 - ], - "rotation_angle_deg": 1.0813371239331713, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0022791100855710233, - 0.00574611144449011, - 0.027007479579891774 - ], - "translation_xyz_cm": [ - -0.22791100855710233, - 0.574611144449011, - 2.7007479579891776 - ], - "translation_norm_m": 0.0277058855258756, - "rotation_rpy_deg_xyz": [ - 0.5172047347275823, - -1.243920438445153, - 0.23715544796713608 - ], - "rotation_angle_deg": 1.3688430767407767, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.009553308095984203, - 0.00994974232273993, - 0.02916989939244939 - ], - "translation_xyz_cm": [ - -0.9553308095984203, - 0.994974232273993, - 2.916989939244939 - ], - "translation_norm_m": 0.03226679560215639, - "rotation_rpy_deg_xyz": [ - -0.6182568414692499, - -1.2732199342731065, - 0.17800383183508972 - ], - "rotation_angle_deg": 1.425676324367976, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.012349733788234896, - 0.0071781819150057435, - -0.05136054253506888 - ], - "translation_xyz_cm": [ - 1.2349733788234896, - 0.7178181915005744, - -5.136054253506888 - ], - "translation_norm_m": 0.053309919806184346, - "rotation_rpy_deg_xyz": [ - -0.11937661233725183, - -0.6309937842808361, - 0.09193837926716758 - ], - "rotation_angle_deg": 0.6486412679040614, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.005762500776254731, - 0.00413490082301915, - -0.021210233278927904 - ], - "translation_xyz_cm": [ - -0.5762500776254731, - 0.413490082301915, - -2.1210233278927904 - ], - "translation_norm_m": 0.02236465550280356, - "rotation_rpy_deg_xyz": [ - 0.11147341198359811, - -0.20435563963405623, - -0.04827864446295908 - ], - "rotation_angle_deg": 0.2376955301690939, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.009564601078873913, - 0.012008259673859545, - -0.02269152436915197 - ], - "translation_xyz_cm": [ - 0.9564601078873913, - 1.2008259673859545, - -2.269152436915197 - ], - "translation_norm_m": 0.02739680952937139, - "rotation_rpy_deg_xyz": [ - 1.0522317952095899, - 0.21279800583519293, - -0.14258070238539514 - ], - "rotation_angle_deg": 1.0832171246083169, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01388283017172709, - 0.0010030126428202113, - -0.024074285482610144 - ], - "translation_xyz_cm": [ - 1.388283017172709, - 0.10030126428202113, - -2.4074285482610143 - ], - "translation_norm_m": 0.027808456077907072, - "rotation_rpy_deg_xyz": [ - 0.9676191955684412, - 0.24244576185523073, - -0.07892468324294306 - ], - "rotation_angle_deg": 1.0008084532584136, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.002720793239309627, - -0.0027614729398491855, - 0.024810968227723804 - ], - "translation_xyz_cm": [ - 0.2720793239309627, - -0.27614729398491855, - 2.4810968227723804 - ], - "translation_norm_m": 0.02511200097653933, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334274723 - ], - "rotation_angle_deg": 1.2215923174512227, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0019675144171404924, - "improved_pairs": 35, - "worsened_pairs": 31, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.0004636456605737749, - "global_consistency_signal": false - } - }, - { - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977520208799274, - 0.004462696353922578, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150318, - 1.2026608220810453, - -0.635510052785851 - ] - }, - "all_pairs": { - "count": 66, - "translation_m": { - "rms": 0.10091495789660097, - "median": 0.057072007424743, - "p90": 0.15889742979161348, - "p95": 0.22209343844560625, - "max": 0.3322636772561496 - }, - "rotation_deg": { - "rms": 1.0152957563636194, - "median": 0.824276911032482, - "p90": 1.5396116364112238, - "p95": 1.721736397530956, - "max": 2.182305990196691 - }, - "normalized_pair_score": { - "rms": 2.8630112438600364, - "median": 2.423863113519335, - "p90": 4.451968500308658, - "p95": 4.918003097359537, - "max": 6.696520710041911 - }, - "normalized_global_rms": 2.8630112438600364 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.013314657207546154, - 0.015730856142696426, - 0.07743008820926582 - ], - "translation_xyz_cm": [ - -1.3314657207546154, - 1.5730856142696426, - 7.743008820926582 - ], - "translation_norm_m": 0.08012589151848082, - "rotation_rpy_deg_xyz": [ - -0.5355339443982136, - -0.10930893417334092, - 0.024668300837139976 - ], - "rotation_angle_deg": 0.547109019070576, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.013314657207546154, - 0.015730856142696426, - 0.07743008820926582 - ], - "translation_xyz_cm": [ - -1.3314657207546154, - 1.5730856142696426, - 7.743008820926582 - ], - "translation_norm_m": 0.08012589151848082, - "rotation_rpy_deg_xyz": [ - -0.5355339443982136, - -0.10930893417334092, - 0.024668300837139976 - ], - "rotation_angle_deg": 0.547109019070576, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.018977957315627902, - -0.010544419632784852, - 0.13303730622105003 - ], - "translation_xyz_cm": [ - 1.8977957315627902, - -1.0544419632784852, - 13.303730622105004 - ], - "translation_norm_m": 0.13479715314434312, - "rotation_rpy_deg_xyz": [ - -0.31914652144259953, - -0.21122341614483142, - -0.34646275641837704 - ], - "rotation_angle_deg": 0.5166365681634427, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030691964249830894, - 0.012971647483750681, - 0.10967170978793495 - ], - "translation_xyz_cm": [ - 3.0691964249830894, - 1.2971647483750681, - 10.967170978793494 - ], - "translation_norm_m": 0.11462174416647401, - "rotation_rpy_deg_xyz": [ - -0.27833863014259486, - -0.2946203532968976, - -0.40251392297711336 - ], - "rotation_angle_deg": 0.5717221816616073, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.03391863028449604, - -0.01588307165538083, - 0.04843205429211943 - ], - "translation_xyz_cm": [ - 3.3918630284496043, - -1.5883071655380832, - 4.843205429211943 - ], - "translation_norm_m": 0.061224254413925684, - "rotation_rpy_deg_xyz": [ - 0.25301234431144376, - 0.07856507161125245, - -0.3515013364272742 - ], - "rotation_angle_deg": 0.4402983357286569, - "pair_index": 3, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04523170697930379, - 0.014903086563413659, - 0.026415847253910878 - ], - "translation_xyz_cm": [ - 4.523170697930379, - 1.490308656341366, - 2.6415847253910876 - ], - "translation_norm_m": 0.054459216772922384, - "rotation_rpy_deg_xyz": [ - 0.35993676811464986, - 0.24664765969644997, - -0.3846128678940189 - ], - "rotation_angle_deg": 0.582161172501526, - "pair_index": 4, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.01195925579552179, - 0.013541565982868153, - -0.029402031699740358 - ], - "translation_xyz_cm": [ - 1.195925579552179, - 1.3541565982868153, - -2.9402031699740356 - ], - "translation_norm_m": 0.034509089766663364, - "rotation_rpy_deg_xyz": [ - 0.49350043746978545, - 0.09079480892185002, - 0.12920228121145672 - ], - "rotation_angle_deg": 0.518052516908019, - "pair_index": 5, - "i": 1, - "j": 4 - }, - { - "translation_xyz_m": [ - 0.00563711988352532, - 0.02151812222751026, - -0.009494983823284823 - ], - "translation_xyz_cm": [ - 0.563711988352532, - 2.151812222751026, - -0.9494983823284823 - ], - "translation_norm_m": 0.02418597574181675, - "rotation_rpy_deg_xyz": [ - 0.25265677596209546, - 0.20523572243396423, - -0.034578606886678666 - ], - "rotation_angle_deg": 0.32738975448002894, - "pair_index": 6, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.031814771562302405, - 0.002674096563466233, - -0.07002645810745761 - ], - "translation_xyz_cm": [ - -3.1814771562302404, - 0.2674096563466233, - -7.002645810745761 - ], - "translation_norm_m": 0.07696125854654239, - "rotation_rpy_deg_xyz": [ - 0.5232134708787116, - 0.45218792670014574, - 0.5310776539185676 - ], - "rotation_angle_deg": 0.8706732532310353, - "pair_index": 7, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.030201713700173966, - -0.01390517428999638, - -0.12718731006789621 - ], - "translation_xyz_cm": [ - -3.0201713700173967, - -1.390517428999638, - -12.718731006789621 - ], - "translation_norm_m": 0.131461436264669, - "rotation_rpy_deg_xyz": [ - 0.6042176970972332, - 0.22227025318415516, - 0.39424218871599054 - ], - "rotation_angle_deg": 0.7543101544010211, - "pair_index": 8, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.030438639522814517, - -0.018412648389471042, - -0.05019333745378557 - ], - "translation_xyz_cm": [ - -3.043863952281452, - -1.8412648389471042, - -5.019333745378557 - ], - "translation_norm_m": 0.0615216020716604, - "rotation_rpy_deg_xyz": [ - 0.4463900452974913, - 0.318991530825338, - 0.5838735792541047 - ], - "rotation_angle_deg": 0.8002960897011339, - "pair_index": 9, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03750265148312712, - -0.03527515584616375, - -0.07556064123872656 - ], - "translation_xyz_cm": [ - -3.750265148312712, - -3.527515584616375, - -7.556064123872656 - ], - "translation_norm_m": 0.09143410738145576, - "rotation_rpy_deg_xyz": [ - 0.5870852895990378, - 0.7143924390784686, - 0.4978279478250889 - ], - "rotation_angle_deg": 1.0484294819479314, - "pair_index": 10, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012899492642063706, - -0.009796543052902063, - -0.030123604990322298 - ], - "translation_xyz_cm": [ - -1.2899492642063706, - -0.9796543052902063, - -3.01236049903223 - ], - "translation_norm_m": 0.03420234997515507, - "rotation_rpy_deg_xyz": [ - 0.3047418481958034, - 0.25845828464587195, - -0.08851206912854949 - ], - "rotation_angle_deg": 0.40941928556312224, - "pair_index": 11, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.014231699011879373, - 0.0036358380633595005, - -0.21019573556432383 - ], - "translation_xyz_cm": [ - 1.4231699011879373, - 0.36358380633595005, - -21.019573556432384 - ], - "translation_norm_m": 0.21070834778103797, - "rotation_rpy_deg_xyz": [ - -0.10886326738779825, - -0.05166856778838729, - 0.2911260770113835 - ], - "rotation_angle_deg": 0.3150343350961785, - "pair_index": 12, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.012534416215775668, - 0.02312276106239165, - -0.19473957064999006 - ], - "translation_xyz_cm": [ - 1.2534416215775668, - 2.312276106239165, - -19.473957064999006 - ], - "translation_norm_m": 0.19650769462278372, - "rotation_rpy_deg_xyz": [ - 0.00878320015870842, - -0.22556277911163353, - 0.39543493496896004 - ], - "rotation_angle_deg": 0.4553437938897115, - "pair_index": 13, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.005720664906388673, - 0.009705636407000673, - -0.1319708615762251 - ], - "translation_xyz_cm": [ - -0.5720664906388673, - 0.9705636407000673, - -13.19708615762251 - ], - "translation_norm_m": 0.13245087274233888, - "rotation_rpy_deg_xyz": [ - 0.4182438085249681, - -0.5183159728890546, - -0.10067872013821087 - ], - "rotation_angle_deg": 0.6733003074377572, - "pair_index": 14, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.006159832747686389, - 0.021566597251051922, - -0.13042403409930997 - ], - "translation_xyz_cm": [ - 0.6159832747686389, - 2.156659725105192, - -13.042403409930998 - ], - "translation_norm_m": 0.13233854437467008, - "rotation_rpy_deg_xyz": [ - -0.840037090330152, - 0.6570642011967021, - 0.2904144812930932 - ], - "rotation_angle_deg": 1.106582027992288, - "pair_index": 15, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.01310277010557609, - -0.00011120966029154467, - -0.05621161364978675 - ], - "translation_xyz_cm": [ - -1.310277010557609, - -0.011120966029154467, - -5.621161364978676 - ], - "translation_norm_m": 0.05771863183705079, - "rotation_rpy_deg_xyz": [ - -0.8100617809077636, - 0.1347822057482451, - -0.21350123200692803 - ], - "rotation_angle_deg": 0.8482577323638302, - "pair_index": 16, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.006835575118559145, - -0.021786642432970398, - 0.0681082039207915 - ], - "translation_xyz_cm": [ - -0.6835575118559145, - -2.17866424329704, - 6.81082039207915 - ], - "translation_norm_m": 0.0718339078501211, - "rotation_rpy_deg_xyz": [ - 0.2506843576111672, - -0.39577345967054717, - -0.4857289455081561 - ], - "rotation_angle_deg": 0.674217492568989, - "pair_index": 17, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0025865182084413574, - -0.002358377205291584, - 0.0015205636432725246 - ], - "translation_xyz_cm": [ - 0.25865182084413574, - -0.2358377205291584, - 0.15205636432725245 - ], - "translation_norm_m": 0.0038162983738538898, - "rotation_rpy_deg_xyz": [ - 0.1196437156776497, - -0.35285794691723626, - -0.48101201637706864 - ], - "rotation_angle_deg": 0.6081452332544839, - "pair_index": 18, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.004478298086699917, - 0.017086883626611926, - -0.06696576517050482 - ], - "translation_xyz_cm": [ - 0.44782980866999167, - 1.7086883626611926, - -6.696576517050482 - ], - "translation_norm_m": 0.06925626650848221, - "rotation_rpy_deg_xyz": [ - -0.7824538874847704, - -0.43842269799839084, - -0.3093948954996378 - ], - "rotation_angle_deg": 0.9497479873876226, - "pair_index": 19, - "i": 7, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.009209302112873963, - 0.022128900702910848, - -0.0606521479458286 - ], - "translation_xyz_cm": [ - 0.9209302112873963, - 2.2128900702910848, - -6.06521479458286 - ], - "translation_norm_m": 0.06521642846835568, - "rotation_rpy_deg_xyz": [ - 0.05141503904963385, - 0.00449354092149435, - 0.00566257803508329 - ], - "rotation_angle_deg": 0.051920517173624524, - "pair_index": 20, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009395879099145299, - 0.04323951223129208, - -0.1066777543289318 - ], - "translation_xyz_cm": [ - 0.9395879099145299, - 4.323951223129208, - -10.66777543289318 - ], - "translation_norm_m": 0.11549061100673828, - "rotation_rpy_deg_xyz": [ - -0.9539751542468863, - -0.22424719955596317, - 0.1665215163658755 - ], - "rotation_angle_deg": 0.9937108406424446, - "pair_index": 21, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005104107111166767, - 0.018430765010071015, - -0.05079439415628105 - ], - "translation_xyz_cm": [ - 0.5104107111166767, - 1.8430765010071015, - -5.079439415628105 - ], - "translation_norm_m": 0.05427536721167679, - "rotation_rpy_deg_xyz": [ - -0.9518976051817746, - -0.08906146713718438, - 0.16495442440099967 - ], - "rotation_angle_deg": 0.9700546737541248, - "pair_index": 22, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.007982667970121149, - -0.009565836663702587, - -0.15547900242423568 - ], - "translation_xyz_cm": [ - -0.7982667970121149, - -0.9565836663702587, - -15.547900242423568 - ], - "translation_norm_m": 0.15597739712481842, - "rotation_rpy_deg_xyz": [ - -0.5624711770128454, - 1.5874171543552886, - -0.3356941185799336 - ], - "rotation_angle_deg": 1.7157208115256655, - "pair_index": 23, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.005508540781188009, - 0.013942437585313106, - -0.03277716863225703 - ], - "translation_xyz_cm": [ - -0.5508540781188009, - 1.3942437585313106, - -3.2777168632257028 - ], - "translation_norm_m": 0.036042729792647187, - "rotation_rpy_deg_xyz": [ - 0.5054479062183199, - 0.37053727338806464, - 0.20121515514486518 - ], - "rotation_angle_deg": 0.657726366657615, - "pair_index": 24, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.009349980520264367, - 0.028036837808086856, - -0.024732490027187637 - ], - "translation_xyz_cm": [ - 0.9349980520264367, - 2.8036837808086856, - -2.473249002718764 - ], - "translation_norm_m": 0.038538065246600375, - "rotation_rpy_deg_xyz": [ - 0.6631716668254954, - 0.8578341641824542, - 0.19039500522721486 - ], - "rotation_angle_deg": 1.100012107447725, - "pair_index": 25, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.01259055479506932, - 0.004507192169358465, - -0.01145244114524217 - ], - "translation_xyz_cm": [ - -1.259055479506932, - 0.4507192169358465, - -1.145244114524217 - ], - "translation_norm_m": 0.01760668223954772, - "rotation_rpy_deg_xyz": [ - -0.5552161207845997, - 2.009421266253433, - 0.6357031086241705 - ], - "rotation_angle_deg": 2.182305990196691, - "pair_index": 26, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.014444091240686019, - 0.02067447541943057, - -0.0010950697256473588 - ], - "translation_xyz_cm": [ - 1.444409124068602, - 2.067447541943057, - -0.10950697256473588 - ], - "translation_norm_m": 0.025244105912904317, - "rotation_rpy_deg_xyz": [ - 0.31124513246765956, - 0.2668531437532043, - -0.014031036738192223 - ], - "rotation_angle_deg": 0.41024525156849595, - "pair_index": 27, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005887579430009948, - 0.008734099703983977, - 0.02065287929130492 - ], - "translation_xyz_cm": [ - -0.5887579430009948, - 0.8734099703983977, - 2.065287929130492 - ], - "translation_norm_m": 0.023183820052032428, - "rotation_rpy_deg_xyz": [ - -0.07069970480496522, - 1.5418459142259642, - 0.4743490717289602 - ], - "rotation_angle_deg": 1.6149869587730064, - "pair_index": 28, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.006586519657956202, - 0.01433644396588507, - 0.24597982514289274 - ], - "translation_xyz_cm": [ - 0.6586519657956202, - 1.433644396588507, - 24.597982514289274 - ], - "translation_norm_m": 0.24648527388896824, - "rotation_rpy_deg_xyz": [ - -0.19311360273658223, - -0.3257197603704734, - -0.2932923739515119 - ], - "rotation_angle_deg": 0.47929971160952844, - "pair_index": 29, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.006241245438570964, - -0.006731203696555832, - 0.029753581260433586 - ], - "translation_xyz_cm": [ - 0.6241245438570964, - -0.6731203696555832, - 2.9753581260433584 - ], - "translation_norm_m": 0.03113740267989985, - "rotation_rpy_deg_xyz": [ - 0.198825597238105, - 1.3268006810040451, - 0.5142543825749741 - ], - "rotation_angle_deg": 1.4359692367424095, - "pair_index": 30, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03180599006725193, - 0.002253261740986945, - 0.23098581957600497 - ], - "translation_xyz_cm": [ - 3.1805990067251932, - 0.2253261740986945, - 23.098581957600498 - ], - "translation_norm_m": 0.23317621456278564, - "rotation_rpy_deg_xyz": [ - 0.16034369761383055, - -0.5134999386071942, - -0.2525930848219163 - ], - "rotation_angle_deg": 0.5939965715201482, - "pair_index": 31, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.024093282302957153, - 0.021175127018938866, - 0.33071177627562726 - ], - "translation_xyz_cm": [ - 2.4093282302957153, - 2.1175127018938866, - 33.071177627562726 - ], - "translation_norm_m": 0.3322636772561496, - "rotation_rpy_deg_xyz": [ - -0.2563013940830721, - 0.22672202245265619, - -0.23254051419459038 - ], - "rotation_angle_deg": 0.4134395755454248, - "pair_index": 32, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.004831525194124664, - 0.020852594550161863, - 0.16039550125020202 - ], - "translation_xyz_cm": [ - 0.4831525194124664, - 2.0852594550161863, - 16.039550125020202 - ], - "translation_norm_m": 0.16181746245840856, - "rotation_rpy_deg_xyz": [ - 0.8856777756756927, - -1.4812056342085482, - -0.744141342521069 - ], - "rotation_angle_deg": 1.8748380811355045, - "pair_index": 33, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.019908010036874924, - 0.037727357918623916, - 0.2218240696534807 - ], - "translation_xyz_cm": [ - -1.9908010036874924, - 3.7727357918623916, - 22.18240696534807 - ], - "translation_norm_m": 0.22588846866712903, - "rotation_rpy_deg_xyz": [ - 0.7326830017201675, - -0.4714411171372534, - -0.6991490251757558 - ], - "rotation_angle_deg": 1.1151964340680316, - "pair_index": 34, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0008463432152936434, - -0.005524821453267714, - 0.11209586605890914 - ], - "translation_xyz_cm": [ - 0.08463432152936434, - -0.5524821453267714, - 11.209586605890914 - ], - "translation_norm_m": 0.11223512434360938, - "rotation_rpy_deg_xyz": [ - -0.718534259765166, - 0.6180768996940113, - 0.004530359058899552 - ], - "rotation_angle_deg": 0.947819164673926, - "pair_index": 35, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.006621797638338478, - -0.00028191046255754415, - -0.04082503010634827 - ], - "translation_xyz_cm": [ - -0.6621797638338478, - -0.028191046255754415, - -4.082503010634827 - ], - "translation_norm_m": 0.041359530469484866, - "rotation_rpy_deg_xyz": [ - -0.5190787323237712, - 0.5728926682292592, - 0.08970289125554348 - ], - "rotation_angle_deg": 0.7785618518380149, - "pair_index": 36, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.004530864092607612, - 0.03905345872700372, - 0.04707509343384675 - ], - "translation_xyz_cm": [ - -0.45308640926076116, - 3.905345872700372, - 4.707509343384675 - ], - "translation_norm_m": 0.06133323560495456, - "rotation_rpy_deg_xyz": [ - -0.8380523330945314, - -0.11317732429063847, - -0.7401789685624982 - ], - "rotation_angle_deg": 1.124375763416718, - "pair_index": 37, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.011689147147424972, - -0.04699249176355669, - -0.017096034617821897 - ], - "translation_xyz_cm": [ - 1.1689147147424972, - -4.699249176355669, - -1.7096034617821898 - ], - "translation_norm_m": 0.05135372277484721, - "rotation_rpy_deg_xyz": [ - 0.10326906176616613, - 0.025313967913603432, - -0.6469944518488367 - ], - "rotation_angle_deg": 0.6556954445211132, - "pair_index": 38, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - 0.0001254436290074601, - 0.005017668284408527, - 0.0014446208443782554 - ], - "translation_xyz_cm": [ - 0.012544362900746009, - 0.5017668284408527, - 0.14446208443782554 - ], - "translation_norm_m": 0.0052229934425030555, - "rotation_rpy_deg_xyz": [ - -0.11264639000956135, - 0.09867563901568227, - 0.14236359183674502 - ], - "rotation_angle_deg": 0.2066908010596958, - "pair_index": 39, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.010923372997102554, - -0.025197399588075542, - -0.02045894923264921 - ], - "translation_xyz_cm": [ - 1.0923372997102554, - -2.519739958807554, - -2.045894923264921 - ], - "translation_norm_m": 0.034246133027527305, - "rotation_rpy_deg_xyz": [ - -1.3692173141255308, - -1.0380162284583052, - 0.15117668573592818 - ], - "rotation_angle_deg": 1.7237415928660529, - "pair_index": 40, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008692432957752017, - 0.0028009215659136055, - 0.05664690565726294 - ], - "translation_xyz_cm": [ - 0.8692432957752017, - 0.28009215659136055, - 5.6646905657262945 - ], - "translation_norm_m": 0.05737835369620029, - "rotation_rpy_deg_xyz": [ - -0.355025584566797, - -0.4408120377458715, - -0.13900903227030892 - ], - "rotation_angle_deg": 0.5831473606925561, - "pair_index": 41, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.01040412406327551, - -0.03158056569172929, - 0.023852236259414197 - ], - "translation_xyz_cm": [ - -1.040412406327551, - -3.158056569172929, - 2.38522362594142 - ], - "translation_norm_m": 0.04092074170281584, - "rotation_rpy_deg_xyz": [ - 1.0548655620257106, - -0.3294414859193639, - -0.21201038202913441 - ], - "rotation_angle_deg": 1.1246915495033545, - "pair_index": 42, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.019667955088666478, - 0.027372494125847524, - 0.045834616794996084 - ], - "translation_xyz_cm": [ - -1.9667955088666478, - 2.7372494125847524, - 4.583461679499608 - ], - "translation_norm_m": 0.056893707813636965, - "rotation_rpy_deg_xyz": [ - 0.09546623284033685, - 1.0775827775049782, - -0.28309517022880676 - ], - "rotation_angle_deg": 1.1184574012171737, - "pair_index": 43, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.000680810561117795, - -0.03623345147140078, - -0.05595427497908071 - ], - "translation_xyz_cm": [ - -0.0680810561117795, - -3.623345147140078, - -5.595427497908071 - ], - "translation_norm_m": 0.06666488878701488, - "rotation_rpy_deg_xyz": [ - 0.49268288279378025, - 0.15825199914177118, - -0.08908409912480708 - ], - "rotation_angle_deg": 0.5252019728243343, - "pair_index": 44, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.02641353367191801, - 0.0047012850090752956, - -0.11935729119007542 - ], - "translation_xyz_cm": [ - 2.641353367191801, - 0.47012850090752956, - -11.935729119007542 - ], - "translation_norm_m": 0.12233535793876829, - "rotation_rpy_deg_xyz": [ - 0.12223918632624643, - 0.5394939332637073, - -0.03218937106782316 - ], - "rotation_angle_deg": 0.5541382586948838, - "pair_index": 45, - "i": 24, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.013258474469764359, - 0.027687038572386413, - -0.11932430129158512 - ], - "translation_xyz_cm": [ - 1.3258474469764359, - 2.7687038572386413, - -11.932430129158513 - ], - "translation_norm_m": 0.12320977286278548, - "rotation_rpy_deg_xyz": [ - 0.0276493173995964, - 0.9049016731683907, - 0.21555739065093543 - ], - "rotation_angle_deg": 0.9305812158627096, - "pair_index": 46, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.013469928515111196, - 0.01643375152725446, - -0.04702377587971042 - ], - "translation_xyz_cm": [ - -1.3469928515111196, - 1.6433751527254459, - -4.702377587971042 - ], - "translation_norm_m": 0.051601769944905757, - "rotation_rpy_deg_xyz": [ - -0.02108664689711353, - -0.04627392585907875, - 0.07066423048106227 - ], - "rotation_angle_deg": 0.08705258513790355, - "pair_index": 47, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.027899363202186556, - 0.026903034247490853, - -0.07367138796561233 - ], - "translation_xyz_cm": [ - -2.7899363202186556, - 2.6903034247490853, - -7.367138796561233 - ], - "translation_norm_m": 0.08324434589561598, - "rotation_rpy_deg_xyz": [ - 0.2409867669170421, - 0.5093600460816013, - 0.3169410311225238 - ], - "rotation_angle_deg": 0.6459827373704309, - "pair_index": 48, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010939616274875219, - 0.015885292939296303, - -0.03310178794161495 - ], - "translation_xyz_cm": [ - -1.093961627487522, - 1.5885292939296303, - -3.3101787941614953 - ], - "translation_norm_m": 0.038311174622300694, - "rotation_rpy_deg_xyz": [ - 0.3785440778586856, - 0.6159343431432545, - 0.24648916494074977 - ], - "rotation_angle_deg": 0.7631660358041191, - "pair_index": 49, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.017135985512061636, - 0.014004140600095916, - 0.04593979842553299 - ], - "translation_xyz_cm": [ - 1.7135985512061636, - 1.4004140600095916, - 4.593979842553299 - ], - "translation_norm_m": 0.050992382105520866, - "rotation_rpy_deg_xyz": [ - 1.3442838020239756, - -0.36852185435074547, - -0.2850593933606435 - ], - "rotation_angle_deg": 1.4218618784137365, - "pair_index": 50, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.007055871333362607, - 0.006861152080546606, - 0.0189587133841662 - ], - "translation_xyz_cm": [ - -0.7055871333362607, - 0.6861152080546606, - 1.8958713384166201 - ], - "translation_norm_m": 0.02136102856438144, - "rotation_rpy_deg_xyz": [ - 1.3308726929538792, - 0.03812900618091576, - 0.3960522522859098 - ], - "rotation_angle_deg": 1.3889476012857718, - "pair_index": 51, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.03249051026845562, - 0.03393818241124302, - 0.08113176989810686 - ], - "translation_xyz_cm": [ - 3.249051026845562, - 3.3938182411243023, - 8.113176989810686 - ], - "translation_norm_m": 0.09375392028967527, - "rotation_rpy_deg_xyz": [ - 1.915321145792926, - -0.5642927668743174, - -0.5129336418772031 - ], - "rotation_angle_deg": 2.05918680761039, - "pair_index": 52, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.01035165580528874, - 0.010808984589524284, - 0.026642183836709077 - ], - "translation_xyz_cm": [ - 1.035165580528874, - 1.0808984589524284, - 2.6642183836709075 - ], - "translation_norm_m": 0.030558090342113067, - "rotation_rpy_deg_xyz": [ - 1.6796519267758923, - 0.14604200808447562, - 0.18829326127872514 - ], - "rotation_angle_deg": 1.6962319982758776, - "pair_index": 53, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014017420625256793, - 0.010008825009426792, - 0.013941540696733937 - ], - "translation_xyz_cm": [ - 1.4017420625256793, - 1.0008825009426792, - 1.3941540696733936 - ], - "translation_norm_m": 0.022159224175349424, - "rotation_rpy_deg_xyz": [ - 0.8472824533054352, - 0.6924972699468647, - -0.5039284014781155 - ], - "rotation_angle_deg": 1.206866980510852, - "pair_index": 54, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.00015260487801693756, - -0.019185702762060775, - 0.008096229162797612 - ], - "translation_xyz_cm": [ - 0.015260487801693756, - -1.9185702762060775, - 0.8096229162797612 - ], - "translation_norm_m": 0.020824586559628874, - "rotation_rpy_deg_xyz": [ - -0.7428475785243823, - -0.3000926755847766, - -0.6995398700125965 - ], - "rotation_angle_deg": 1.0648693173338337, - "pair_index": 55, - "i": 29, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0038331907039319546, - 0.02340287336025282, - 0.05614344570681083 - ], - "translation_xyz_cm": [ - -0.38331907039319546, - 2.340287336025282, - 5.614344570681083 - ], - "translation_norm_m": 0.060946487415784324, - "rotation_rpy_deg_xyz": [ - -1.2295910627015747, - -0.5146874739254865, - 0.6115327195593013 - ], - "rotation_angle_deg": 1.4642363140494412, - "pair_index": 56, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.009690735530324623, - 0.004653170314430355, - 0.035294328624991586 - ], - "translation_xyz_cm": [ - 0.9690735530324623, - 0.4653170314430355, - 3.5294328624991587 - ], - "translation_norm_m": 0.036895148491132165, - "rotation_rpy_deg_xyz": [ - -0.31513998336533716, - -0.2141940157510921, - 0.4953590423367678 - ], - "rotation_angle_deg": 0.6244903967618453, - "pair_index": 57, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.010947220180813622, - -0.03170718966340019, - 0.0186010629192054 - ], - "translation_xyz_cm": [ - -1.0947220180813622, - -3.1707189663400195, - 1.86010629192054 - ], - "translation_norm_m": 0.0383560562071009, - "rotation_rpy_deg_xyz": [ - 0.8370618070321811, - -0.6739925190910833, - -0.12485818713744094 - ], - "rotation_angle_deg": 1.0813371239331708, - "pair_index": 58, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0053865347058952295, - -0.007425116242552987, - 0.026573012796881706 - ], - "translation_xyz_cm": [ - -0.538653470589523, - -0.7425116242552987, - 2.6573012796881708 - ], - "translation_norm_m": 0.028111778962856066, - "rotation_rpy_deg_xyz": [ - 0.5172047347275823, - -1.243920438445153, - 0.237155447967133 - ], - "rotation_angle_deg": 1.3688430767407762, - "pair_index": 59, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.020732733130354397, - 1.4957174660823469e-05, - 0.028656318943141107 - ], - "translation_xyz_cm": [ - -2.0732733130354397, - 0.001495717466082347, - 2.865631894314111 - ], - "translation_norm_m": 0.03536991747435377, - "rotation_rpy_deg_xyz": [ - -0.6182568414692499, - -1.2732199342731065, - 0.17800383183508972 - ], - "rotation_angle_deg": 1.425676324367976, - "pair_index": 60, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - -0.00010639052652550163, - 0.024898921500229765, - -0.051552206983603015 - ], - "translation_xyz_cm": [ - -0.010639052652550163, - 2.4898921500229765, - -5.155220698360301 - ], - "translation_norm_m": 0.05725030703584904, - "rotation_rpy_deg_xyz": [ - -0.11937661233725184, - -0.6309937842808361, - 0.0919383792671678 - ], - "rotation_angle_deg": 0.6486412679040614, - "pair_index": 61, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00486040978797142, - 0.0002558414003355214, - -0.02124869507791763 - ], - "translation_xyz_cm": [ - -0.48604097879714203, - 0.02558414003355214, - -2.1248695077917628 - ], - "translation_norm_m": 0.021798992652034516, - "rotation_rpy_deg_xyz": [ - 0.11147341198359842, - -0.20435563963405623, - -0.048278644462965606 - ], - "rotation_angle_deg": 0.23769553016909534, - "pair_index": 62, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.010668777398309404, - 0.028608197246107858, - -0.02214058432095123 - ], - "translation_xyz_cm": [ - 1.0668777398309404, - 2.860819724610786, - -2.214058432095123 - ], - "translation_norm_m": 0.03771547739218002, - "rotation_rpy_deg_xyz": [ - 1.0522317952095899, - 0.21279800583519293, - -0.14258070238539514 - ], - "rotation_angle_deg": 1.0832171246083169, - "pair_index": 63, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01620790570293229, - 0.021387586214915655, - -0.023411925030935348 - ], - "translation_xyz_cm": [ - 1.620790570293229, - 2.1387586214915655, - -2.3411925030935348 - ], - "translation_norm_m": 0.0356124035278403, - "rotation_rpy_deg_xyz": [ - 0.9676191955684417, - 0.24244576185523073, - -0.07892468324294306 - ], - "rotation_angle_deg": 1.0008084532584136, - "pair_index": 64, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.004724714533978824, - 0.005398902444147535, - 0.025142779046231058 - ], - "translation_xyz_cm": [ - 0.47247145339788243, - 0.5398902444147535, - 2.5142779046231056 - ], - "translation_norm_m": 0.026146326954213064, - "rotation_rpy_deg_xyz": [ - 1.2132782648708806, - -0.1403570137683193, - 0.021891548334274723 - ], - "rotation_angle_deg": 1.2215923174512227, - "pair_index": 65, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.007369852417388412, - "improved_pairs": 18, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.00446840177433383, - "global_consistency_signal": false - } - } - ] -} diff --git a/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.csv b/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.csv deleted file mode 100644 index f3dcbce..0000000 --- a/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.csv +++ /dev/null @@ -1,19 +0,0 @@ -label,roll_correction_deg,pitch_correction_deg,yaw_correction_deg,selected_pair_translation_cm,selected_pair_rotation_deg,all_pair_translation_rms_m,all_pair_rotation_rms_deg,normalized_global_rms,normalized_global_rms_change,improved_pairs,worsened_pairs,global_consistency_signal,ground_normal_tilt_rms_deg,ground_height_rms_m -baseline,0.0,0.0,0.0,9.17040157943579,0.3948131792835417,0.11878243181951181,1.1425260172834293,3.296235617224735,0.0,0,0,False,1.6662748432297785,0.03471396517121729 -pitch_+0.100,0.0,0.1,0.0,9.076928136371041,0.4171107485761563,0.11876672804528438,1.1650719587800913,3.3274291807303316,0.031193563505596433,37,43,False,1.661255702204205,0.03471396517121729 -pitch_+0.200,0.0,0.2,0.0,8.983515248729091,0.4394867360130287,0.11886418170047355,1.2000618469690334,3.378175724075376,0.08194010685064068,33,47,False,1.6622470214176333,0.03471396517121729 -pitch_+0.300,0.0,0.3,0.0,8.890164410286015,0.4619296835950138,0.11907438084482405,1.246448116042569,3.4476100262900324,0.1513744090652973,29,51,False,1.669238092496052,0.034713965171217276 -pitch_+0.000_roll_-0.200,-0.2,0.0,0.0,9.01972941526644,0.4032977537513619,0.12043024872839399,1.1611526935950138,3.3458153318563415,0.049579714631606375,32,48,False,1.7107124278398285,0.034713965171217304 -pitch_+0.000_roll_-0.100,-0.1,0.0,0.0,9.095041148790378,0.3984113441028921,0.1195670451553767,1.1451882592248208,3.3112438616237037,0.015008244398968529,36,44,False,1.685676496509504,0.034713965171217304 -pitch_+0.000_roll_+0.100,0.1,0.0,0.0,9.245809148607497,0.39253869750368725,0.1180779565326178,1.153258101553409,3.3010571825949637,0.004821565370228598,39,41,False,1.652705907802981,0.034713965171217304 -pitch_+0.100_roll_-0.200,-0.2,0.1,0.0,8.926223519858327,0.4251505609368216,0.12047176074785593,1.1833438511380916,3.3773641697603143,0.08112855253557916,35,45,False,1.7058242505297496,0.034713965171217304 -pitch_+0.100_roll_-0.100,-0.1,0.1,0.0,9.001551548682645,0.4205181630564456,0.1195801596045202,1.1676828282839524,3.342708269995132,0.046472652770396916,34,46,False,1.6807154082401394,0.03471396517121729 -pitch_+0.100_roll_+0.100,0.1,0.1,0.0,9.152351713867697,0.41495850563128295,0.11803306342745587,1.175598202053685,3.331793234208173,0.035557616983437956,33,47,False,1.6476453039285432,0.0347139651712173 -pitch_+0.200_roll_-0.200,-0.2,0.2,0.0,8.832778133209484,0.4471243504044202,0.12062476910644687,1.2178088730560497,3.428172658132847,0.13193704090811176,30,50,False,1.7067898021773054,0.034713965171217304 -pitch_+0.200_roll_-0.100,-0.1,0.2,0.0,8.908122483450981,0.44272195299870193,0.11970563817510238,1.2025967761770837,3.3936310861155006,0.09739546889076545,33,47,False,1.6816953294526065,0.03471396517121731 -pitch_+0.200_roll_+0.100,0.1,0.2,0.0,9.058954849462527,0.4374446064319599,0.11810204126073977,1.2102837520093128,3.3820679918494174,0.0858323746246823,32,48,False,1.648644705864238,0.034713965171217304 -pitch_+0.300_roll_-0.200,-0.2,0.3,0.0,8.739394768298625,0.469202063453847,0.1208887180452031,1.263543756747655,3.4973996284538247,0.20116401122908956,29,51,False,1.7135991876939975,0.03471396517121731 -pitch_+0.300_roll_-0.100,-0.1,0.3,0.0,8.81475545648032,0.46500876133584307,0.11994299492844523,1.2488889095688314,3.4631521547194706,0.16691653749473545,30,50,False,1.6886059172123598,0.0347139651712173 -pitch_+0.300_roll_+0.100,0.1,0.3,0.0,8.96562003954328,0.45998721539756443,0.11828455597352863,1.2562925755921872,3.4510257337050003,0.1547901164802652,29,51,False,1.6556931398905776,0.034713965171217304 -yaw_-0.200_diagnostic,0.0,0.0,-0.2,9.118174501598277,0.39481317928354154,0.11873527555886121,1.142526017283429,3.295555956965929,-0.0006796602588061695,45,35,True,1.6662748432297787,0.0347139651712173 -yaw_+0.200_diagnostic,0.0,0.0,0.2,9.225647367504836,0.39481317928354204,0.1194719055604376,1.142526017283429,3.306187727273662,0.009952110048927043,27,53,False,1.6662748432297787,0.0347139651712173 diff --git a/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.json b/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.json deleted file mode 100644 index ad9225b..0000000 --- a/results/01_previous_two_batches/diagnostics/small_gicp_refined_pair0_left_rpy_scan.json +++ /dev/null @@ -1,33675 +0,0 @@ -{ - "schema_version": 1, - "diagnostic_only": true, - "extrinsic_was_modified": false, - "equation": "delta_ij = B_ij^-1 * (X^-1 * A_ij * X)", - "correction_convention": "X_test = DeltaR_body * X; DeltaR uses fixed body xyz RPY axes", - "component_frame": "delta translation/RPY components are in station-j LiDAR coordinates, not screen axes", - "selection_rule": "Never accept a correction from selected_pair alone. Require improvement over all refined pairs, directional consistency across pairs, acceptable ground constraints, and independent visual review. This script never overwrites X.", - "pairs_file": "results\\01_previous_two_batches\\small_gicp\\B_batch2_refined.npz", - "extrinsic_file": "results\\01_previous_two_batches\\final_extrinsic_recommended.json", - "stations": 38, - "pairs": 80, - "selected_pair_index": 0, - "selected_pair_stations": [ - 0, - 1 - ], - "normalization": { - "translation_scale_m": 0.05, - "rotation_scale_deg": 0.5 - }, - "z_observability": { - "body_left_z_test_shift_m": 0.1, - "max_predicted_motion_change_translation_m": 9.977540720306595e-16, - "max_predicted_motion_change_rotation_deg": 0.0, - "numerically_unobservable": true, - "note": "AX pairs cannot determine X.z when every A rotation preserves body Z; use ground/external height constraints." - }, - "ranking_by_all_pair_normalized_rms": [ - { - "rank": 1, - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "normalized_global_rms": 3.295555956965929, - "normalized_global_rms_change": -0.0006796602588061695, - "improved_pairs": 45, - "worsened_pairs": 35, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.0021608242414224432, - "global_consistency_signal": true - }, - { - "rank": 2, - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "normalized_global_rms": 3.296235617224735, - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 80, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - }, - { - "rank": 3, - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 3.3010571825949637, - "normalized_global_rms_change": 0.004821565370228598, - "improved_pairs": 39, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0017696484744595953, - "global_consistency_signal": false - }, - { - "rank": 4, - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "normalized_global_rms": 3.306187727273662, - "normalized_global_rms_change": 0.009952110048927043, - "improved_pairs": 27, - "worsened_pairs": 53, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.005036973923611132, - "global_consistency_signal": false - }, - { - "rank": 5, - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "normalized_global_rms": 3.3112438616237037, - "normalized_global_rms_change": 0.015008244398968529, - "improved_pairs": 36, - "worsened_pairs": 44, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.022882341914364612, - "global_consistency_signal": false - }, - { - "rank": 6, - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "normalized_global_rms": 3.3274291807303316, - "normalized_global_rms_change": 0.031193563505596433, - "improved_pairs": 37, - "worsened_pairs": 43, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.027643515853556178, - "global_consistency_signal": false - }, - { - "rank": 7, - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 3.331793234208173, - "normalized_global_rms_change": 0.035557616983437956, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.021922643950929743, - "global_consistency_signal": false - }, - { - "rank": 8, - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "normalized_global_rms": 3.342708269995132, - "normalized_global_rms_change": 0.046472652770396916, - "improved_pairs": 34, - "worsened_pairs": 46, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.03779273410144712, - "global_consistency_signal": false - }, - { - "rank": 9, - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "normalized_global_rms": 3.3458153318563415, - "normalized_global_rms_change": 0.049579714631606375, - "improved_pairs": 32, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.04862337050743348, - "global_consistency_signal": false - }, - { - "rank": 10, - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "normalized_global_rms": 3.3773641697603143, - "normalized_global_rms_change": 0.08112855253557916, - "improved_pairs": 35, - "worsened_pairs": 45, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07613696756808985, - "global_consistency_signal": false - }, - { - "rank": 11, - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "normalized_global_rms": 3.378175724075376, - "normalized_global_rms_change": 0.08194010685064068, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0682090297399528, - "global_consistency_signal": false - }, - { - "rank": 12, - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 3.3820679918494174, - "normalized_global_rms_change": 0.0858323746246823, - "improved_pairs": 32, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07205204282391175, - "global_consistency_signal": false - }, - { - "rank": 13, - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "normalized_global_rms": 3.3936310861155006, - "normalized_global_rms_change": 0.09739546889076545, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09243174829989087, - "global_consistency_signal": false - }, - { - "rank": 14, - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "normalized_global_rms": 3.428172658132847, - "normalized_global_rms_change": 0.13193704090811176, - "improved_pairs": 30, - "worsened_pairs": 50, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.11498894516263114, - "global_consistency_signal": false - }, - { - "rank": 15, - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.4476100262900324, - "normalized_global_rms_change": 0.1513744090652973, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10792431432082006, - "global_consistency_signal": false - }, - { - "rank": 16, - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.4510257337050003, - "normalized_global_rms_change": 0.1547901164802652, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10680505252074268, - "global_consistency_signal": false - }, - { - "rank": 17, - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.4631521547194706, - "normalized_global_rms_change": 0.16691653749473545, - "improved_pairs": 30, - "worsened_pairs": 50, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.15210042200009888, - "global_consistency_signal": false - }, - { - "rank": 18, - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "normalized_global_rms": 3.4973996284538247, - "normalized_global_rms_change": 0.20116401122908956, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.20872780916647726, - "global_consistency_signal": false - } - ], - "candidates": [ - { - "label": "baseline", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11878243181951181, - "median": 0.061014663949839676, - "p90": 0.19300805216380018, - "p95": 0.23804000465094943, - "max": 0.3874359918835575 - }, - "rotation_deg": { - "rms": 1.1425260172834293, - "median": 0.9282640065321243, - "p90": 1.7009781890331424, - "p95": 2.048721717062998, - "max": 2.753259244049476 - }, - "normalized_pair_score": { - "rms": 3.296235617224735, - "median": 2.563382903474642, - "p90": 4.956872640531746, - "p95": 5.656581505717681, - "max": 8.143356508341247 - }, - "normalized_global_rms": 3.296235617224735 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018487057728777623, - 0.021202287551202792, - 0.08728297779029309 - ], - "translation_xyz_cm": [ - -1.8487057728777623, - 2.120228755120279, - 8.72829777902931 - ], - "translation_norm_m": 0.0917040157943579, - "rotation_rpy_deg_xyz": [ - 0.3707297631131401, - 0.09797750843591149, - 0.09432476801658236 - ], - "rotation_angle_deg": 0.3948131792835417, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297785, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018487057728777623, - 0.021202287551202792, - 0.08728297779029309 - ], - "translation_xyz_cm": [ - -1.8487057728777623, - 2.120228755120279, - 8.72829777902931 - ], - "translation_norm_m": 0.0917040157943579, - "rotation_rpy_deg_xyz": [ - 0.3707297631131401, - 0.09797750843591149, - 0.09432476801658236 - ], - "rotation_angle_deg": 0.3948131792835417, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019075485705950967, - -0.0229194477559449, - 0.1726041878832843 - ], - "translation_xyz_cm": [ - 1.9075485705950967, - -2.29194477559449, - 17.26041878832843 - ], - "translation_norm_m": 0.1751610142560368, - "rotation_rpy_deg_xyz": [ - -0.3939273922561942, - -0.32712007079357863, - -0.3560459562718856 - ], - "rotation_angle_deg": 0.6243032572335695, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.02918915234030528, - 0.004450721817294223, - 0.15262196265219305 - ], - "translation_xyz_cm": [ - 2.918915234030528, - 0.4450721817294223, - 15.262196265219306 - ], - "translation_norm_m": 0.15545185435641448, - "rotation_rpy_deg_xyz": [ - -0.09360092985287004, - -0.27561250809209464, - -0.3919021207581219 - ], - "rotation_angle_deg": 0.48835107122742005, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.010377693307476864, - 6.732525774344467e-05, - 0.10447615517587222 - ], - "translation_xyz_cm": [ - -1.0377693307476863, - 0.006732525774344467, - 10.447615517587222 - ], - "translation_norm_m": 0.10499032360845123, - "rotation_rpy_deg_xyz": [ - 0.5624351601401003, - 0.08248813613935406, - 0.20158592242858958 - ], - "rotation_angle_deg": 0.6030015485331487, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.020848602530708527, - -0.0031124299678002565, - -0.023324429961452564 - ], - "translation_xyz_cm": [ - -2.0848602530708527, - -0.31124299678002565, - -2.3324429961452564 - ], - "translation_norm_m": 0.031438519062046054, - "rotation_rpy_deg_xyz": [ - 0.5700916761153975, - -0.1503949752368123, - 0.05601991987790396 - ], - "rotation_angle_deg": 0.5923217154285064, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.030836947081705812, - -0.017726811597074177, - 0.07536359753711162 - ], - "translation_xyz_cm": [ - 3.0836947081705812, - -1.7726811597074177, - 7.536359753711162 - ], - "translation_norm_m": 0.08333564056544969, - "rotation_rpy_deg_xyz": [ - 0.36259104517619095, - 0.06185223683678944, - -0.34427063365444066 - ], - "rotation_angle_deg": 0.5039390549857715, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0423631987919203, - 0.006861791525663796, - 0.06588150200751139 - ], - "translation_xyz_cm": [ - 4.236319879192029, - 0.6861791525663796, - 6.588150200751139 - ], - "translation_norm_m": 0.07862631303572078, - "rotation_rpy_deg_xyz": [ - 0.6786232936253765, - 0.36376569906588635, - -0.3609782840902748 - ], - "rotation_angle_deg": 0.8513002721677734, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0008065869947393722, - -0.004387587732284315, - 0.002850635394587589 - ], - "translation_xyz_cm": [ - -0.08065869947393722, - -0.4387587732284315, - 0.2850635394587589 - ], - "translation_norm_m": 0.005294112847441963, - "rotation_rpy_deg_xyz": [ - 0.9426303288087607, - 0.24507818632054507, - 0.02038675507284647 - ], - "rotation_angle_deg": 0.9741392658395046, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004924002608155791, - 0.0195681716684184, - 0.0016277059862484112 - ], - "translation_xyz_cm": [ - 0.4924002608155791, - 1.95681716684184, - 0.1627705986248411 - ], - "translation_norm_m": 0.020243729174919487, - "rotation_rpy_deg_xyz": [ - 0.3366397867492941, - 0.23438366247184536, - -0.025320892185125007 - ], - "rotation_angle_deg": 0.4110205637642511, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03938905416063192, - -0.002334048124978949, - -0.03459296647089222 - ], - "translation_xyz_cm": [ - -3.9389054160631916, - -0.2334048124978949, - -3.4592966470892215 - ], - "translation_norm_m": 0.0524749339930522, - "rotation_rpy_deg_xyz": [ - 0.7112686540591545, - 0.8835902165009863, - 0.5757505925688086 - ], - "rotation_angle_deg": 1.2695618641147897, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.050988302543561376, - -0.025015770349635646, - -0.043434367055747033 - ], - "translation_xyz_cm": [ - -5.0988302543561375, - -2.5015770349635646, - -4.343436705574703 - ], - "translation_norm_m": 0.07149923079301497, - "rotation_rpy_deg_xyz": [ - 0.7934266378138218, - 1.4177856745388515, - 0.49273638754455873 - ], - "rotation_angle_deg": 1.694906703112195, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03352231721448763, - -0.020007626123802552, - -0.04282382217649132 - ], - "translation_xyz_cm": [ - -3.352231721448763, - -2.0007626123802553, - -4.282382217649132 - ], - "translation_norm_m": 0.057947653967545136, - "rotation_rpy_deg_xyz": [ - 0.5301095135140874, - 0.4797815990997577, - 0.5980872587711363 - ], - "rotation_angle_deg": 0.9307274823147854, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04099528684880817, - -0.04043932502820846, - -0.05145931841369948 - ], - "translation_xyz_cm": [ - -4.099528684880817, - -4.043932502820846, - -5.145931841369948 - ], - "translation_norm_m": 0.07722702897402996, - "rotation_rpy_deg_xyz": [ - 0.7406777446660228, - 0.9837317035119634, - 0.5174743722263389 - ], - "rotation_angle_deg": 1.3332317227955521, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012609842410948632, - -0.013055387836963112, - -0.009696273917734703 - ], - "translation_xyz_cm": [ - -1.2609842410948633, - -1.3055387836963113, - -0.9696273917734702 - ], - "translation_norm_m": 0.020578362546379278, - "rotation_rpy_deg_xyz": [ - 0.3878570945185718, - 0.3495858886889525, - -0.0870544641590225 - ], - "rotation_angle_deg": 0.529553956323026, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008428998252300202, - -0.012524759557640708, - -0.19132271276904278 - ], - "translation_xyz_cm": [ - 0.8428998252300202, - -1.2524759557640708, - -19.132271276904277 - ], - "translation_norm_m": 0.19191742504217704, - "rotation_rpy_deg_xyz": [ - -0.8714863889544837, - 0.06298456568900439, - 0.3310526381993087 - ], - "rotation_angle_deg": 0.9345407340946449, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0004416417883389423, - 0.010133634692792118, - -0.23631514759437777 - ], - "translation_xyz_cm": [ - -0.04416417883389423, - 1.0133634692792117, - -23.631514759437778 - ], - "translation_norm_m": 0.2365327346946057, - "rotation_rpy_deg_xyz": [ - -0.5535749283448294, - -0.22435758897423883, - 0.4316530615420699 - ], - "rotation_angle_deg": 0.7363206713983871, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.006193203562112171, - 0.0012960546523946848, - -0.022003976914247256 - ], - "translation_xyz_cm": [ - -0.6193203562112171, - 0.12960546523946848, - -2.2003976914247256 - ], - "translation_norm_m": 0.02289564430337087, - "rotation_rpy_deg_xyz": [ - 0.1224299601722492, - -0.07544176478257476, - -0.09917566305373945 - ], - "rotation_angle_deg": 0.17464355779766502, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - -1.7042007900786027e-05, - 0.026928255237324006, - -0.26531508784453206 - ], - "translation_xyz_cm": [ - -0.0017042007900786027, - 2.6928255237324006, - -26.531508784453205 - ], - "translation_norm_m": 0.266678133821482, - "rotation_rpy_deg_xyz": [ - -0.6268743701120475, - -0.0899960514267489, - 0.06819689901760506 - ], - "rotation_angle_deg": 0.6369099654382246, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0025228673075068375, - 0.014759571263051607, - -0.161406415628912 - ], - "translation_xyz_cm": [ - -0.25228673075068375, - 1.4759571263051607, - -16.1406415628912 - ], - "translation_norm_m": 0.16209947812838102, - "rotation_rpy_deg_xyz": [ - -0.5298420205475538, - 0.7331699857076515, - 0.27623490163261255 - ], - "rotation_angle_deg": 0.9468072491989288, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.005943702539087159, - 0.026731938345367467, - 0.009453323578095571 - ], - "translation_xyz_cm": [ - 0.5943702539087159, - 2.6731938345367467, - 0.9453323578095572 - ], - "translation_norm_m": 0.0289704928202103, - "rotation_rpy_deg_xyz": [ - 0.26424871811137973, - -0.8312384021288093, - -0.25157673765718247 - ], - "rotation_angle_deg": 0.9072533325217047, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.01425976865844314, - -0.028057129173041942, - -0.023950125183871407 - ], - "translation_xyz_cm": [ - -1.425976865844314, - -2.805712917304194, - -2.3950125183871407 - ], - "translation_norm_m": 0.03954936151125818, - "rotation_rpy_deg_xyz": [ - 0.06763169804302012, - -0.33907715109670894, - -0.48023678683644355 - ], - "rotation_angle_deg": 0.5915926019510631, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004649470404931022, - 0.008347886558832396, - -0.004816625466088093 - ], - "translation_xyz_cm": [ - 0.4649470404931022, - 0.8347886558832396, - -0.4816625466088093 - ], - "translation_norm_m": 0.010700685301700652, - "rotation_rpy_deg_xyz": [ - 0.44261202761711166, - -0.601736452980534, - -0.48315899939190393 - ], - "rotation_angle_deg": 0.8883601428323118, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.020743321456745845, - 0.011205921561111332, - -0.20144873715372635 - ], - "translation_xyz_cm": [ - -2.0743321456745845, - 1.1205921561111332, - -20.144873715372636 - ], - "translation_norm_m": 0.20282369625840763, - "rotation_rpy_deg_xyz": [ - -0.6549444331810687, - 0.9454238796571128, - -0.6411517255029521 - ], - "rotation_angle_deg": 1.314116259589663, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.03056918105872046, - 0.024448618167540737, - -0.22348947733836078 - ], - "translation_xyz_cm": [ - -3.056918105872046, - 2.4448618167540737, - -22.348947733836077 - ], - "translation_norm_m": 0.22689150764600405, - "rotation_rpy_deg_xyz": [ - -0.15842786720352073, - 0.8143631630688583, - -0.4120085139951705 - ], - "rotation_angle_deg": 0.9258005307494631, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01111018347532372, - 0.030183588959605934, - -0.03554610471792013 - ], - "translation_xyz_cm": [ - 1.111018347532372, - 3.0183588959605934, - -3.554610471792013 - ], - "translation_norm_m": 0.0479375716943938, - "rotation_rpy_deg_xyz": [ - 0.34991688769963164, - -0.11335075473918371, - -0.011973693588123899 - ], - "rotation_angle_deg": 0.36800171459898384, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011789150675137972, - 0.044294663676553325, - -0.13574148677629394 - ], - "translation_xyz_cm": [ - 1.1789150675137972, - 4.4294663676553325, - -13.574148677629394 - ], - "translation_norm_m": 0.14327160408154457, - "rotation_rpy_deg_xyz": [ - -0.5313552290312359, - -0.27832031757742437, - 0.16276072252893073 - ], - "rotation_angle_deg": 0.6211849404404549, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005415035370696375, - 0.0184190779874156, - -0.08707977112478751 - ], - "translation_xyz_cm": [ - 0.5415035370696375, - 1.84190779874156, - -8.707977112478751 - ], - "translation_norm_m": 0.08917102433592299, - "rotation_rpy_deg_xyz": [ - -0.7502793178689086, - -0.14157482299150662, - 0.16180554413495635 - ], - "rotation_angle_deg": 0.7802838421023639, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.010929453006329526, - -0.0253168608397476, - -0.16370959021789014 - ], - "translation_xyz_cm": [ - -1.0929453006329526, - -2.53168608397476, - -16.370959021789012 - ], - "translation_norm_m": 0.1660157411666322, - "rotation_rpy_deg_xyz": [ - -0.8504211978103172, - 2.259974110880241, - -0.3732463520213588 - ], - "rotation_angle_deg": 2.4407739487514917, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.003743189575096839, - 0.020699166968187188, - -0.021416915389566436 - ], - "translation_xyz_cm": [ - 0.3743189575096839, - 2.069916696818719, - -2.1416915389566435 - ], - "translation_norm_m": 0.030019181304223687, - "rotation_rpy_deg_xyz": [ - 1.001901640142309, - 0.09209745150596131, - 0.21914502953724876 - ], - "rotation_angle_deg": 1.0295431056764424, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.006934760385390204, - 0.03613641274673296, - 0.060517657113028825 - ], - "translation_xyz_cm": [ - 0.6934760385390204, - 3.613641274673296, - 6.051765711302883 - ], - "translation_norm_m": 0.07082597016811806, - "rotation_rpy_deg_xyz": [ - 1.1458312633579384, - 1.5653220513390178, - 0.15413107840224605 - ], - "rotation_angle_deg": 1.9447390375576619, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.014836634990273101, - 0.004270689093823776, - -0.02297540441586879 - ], - "translation_xyz_cm": [ - -1.48366349902731, - 0.4270689093823776, - -2.2975404415868788 - ], - "translation_norm_m": 0.027680927210688308, - "rotation_rpy_deg_xyz": [ - -0.10107722918942123, - 2.2989243210632977, - 0.688858665378206 - ], - "rotation_angle_deg": 2.402607849811503, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.006185703460469538, - -0.00013850981512431026, - 0.3872184127025844 - ], - "translation_xyz_cm": [ - 0.6185703460469538, - -0.013850981512431026, - 38.72184127025844 - ], - "translation_norm_m": 0.38726784174286755, - "rotation_rpy_deg_xyz": [ - -1.1949945190290059, - 0.3867227936693216, - -0.06218009608488708 - ], - "rotation_angle_deg": 1.2573486710805661, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0108210569078524, - 0.03684597566754366, - 0.049791033737942386 - ], - "translation_xyz_cm": [ - 1.08210569078524, - 3.6845975667543662, - 4.9791033737942385 - ], - "translation_norm_m": 0.06287979195408583, - "rotation_rpy_deg_xyz": [ - 1.41823154782434, - -0.37351388423595594, - 0.056605451472074415 - ], - "rotation_angle_deg": 1.4678602012812054, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.008075886252850717, - 0.016689030221201717, - 0.006324892188280098 - ], - "translation_xyz_cm": [ - -0.8075886252850717, - 1.6689030221201717, - 0.6324892188280098 - ], - "translation_norm_m": 0.01958948518176356, - "rotation_rpy_deg_xyz": [ - 0.09640101139075873, - 1.9693817150237038, - 0.4849368785656181 - ], - "rotation_angle_deg": 2.030096131128867, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.02739982539653929, - 0.023479970331568012, - 0.15152875186426518 - ], - "translation_xyz_cm": [ - 2.739982539653929, - 2.347997033156801, - 15.152875186426517 - ], - "translation_norm_m": 0.1557659207916616, - "rotation_rpy_deg_xyz": [ - -0.03748910221010643, - -0.9361241695856968, - -0.30010823429898126 - ], - "rotation_angle_deg": 0.983860065442221, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0025216059740571506, - 0.009324667900165728, - 0.38731555594716205 - ], - "translation_xyz_cm": [ - 0.25216059740571506, - 0.9324667900165728, - 38.731555594716205 - ], - "translation_norm_m": 0.3874359918835575, - "rotation_rpy_deg_xyz": [ - -0.5311916053182182, - 0.34563564492307863, - -0.24522044123122747 - ], - "rotation_angle_deg": 0.6789509051411448, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.017217321601399993, - 0.011699476969499467, - 0.058199096892274954 - ], - "translation_xyz_cm": [ - -1.7217321601399993, - 1.1699476969499467, - 5.8199096892274955 - ], - "translation_norm_m": 0.06180977919036996, - "rotation_rpy_deg_xyz": [ - 0.8751601758841602, - 2.5470806194099076, - 0.5917116810425554 - ], - "rotation_angle_deg": 2.753259244049476, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0305591877577589, - 0.0035130724039467154, - 0.18531194685575822 - ], - "translation_xyz_cm": [ - 3.05591877577589, - 0.35130724039467154, - 18.531194685575823 - ], - "translation_norm_m": 0.18784760653679006, - "rotation_rpy_deg_xyz": [ - 0.260427332163708, - -0.3474619528536646, - -0.22819641071055846 - ], - "rotation_angle_deg": 0.49016829023833824, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0333063692698119, - 0.009735904370645532, - 0.31621552937870856 - ], - "translation_xyz_cm": [ - 3.3306369269811897, - 0.9735904370645532, - 31.621552937870856 - ], - "translation_norm_m": 0.31811375809308895, - "rotation_rpy_deg_xyz": [ - 0.11050162149875117, - -0.11834298782643238, - -0.24015309961140904 - ], - "rotation_angle_deg": 0.2895415816677459, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.026910742428379875, - 0.019562801180121436, - 0.07603073070196034 - ], - "translation_xyz_cm": [ - 2.6910742428379875, - 1.9562801180121436, - 7.603073070196034 - ], - "translation_norm_m": 0.08299134448322656, - "rotation_rpy_deg_xyz": [ - 0.8637339453585894, - -2.382016409532787, - -0.7937090222621455 - ], - "rotation_angle_deg": 2.649773797051862, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012950203121564918, - 0.0264496793048008, - 0.21374059060764122 - ], - "translation_xyz_cm": [ - -1.2950203121564918, - 2.64496793048008, - 21.37405906076412 - ], - "translation_norm_m": 0.21575989750071695, - "rotation_rpy_deg_xyz": [ - 0.6416163681111159, - -0.768162938994497, - -0.7372200176480656 - ], - "rotation_angle_deg": 1.2405150413124735, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.003188553543695738, - -0.020434338839635746, - 0.16764097616779672 - ], - "translation_xyz_cm": [ - -0.3188553543695738, - -2.0434338839635746, - 16.764097616779672 - ], - "translation_norm_m": 0.16891188817844008, - "rotation_rpy_deg_xyz": [ - -1.047224908872662, - 0.5013606987807923, - -0.026181905990093984 - ], - "rotation_angle_deg": 1.1612411936043427, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.003482360004180285, - -0.008011604516453996, - -0.052015923582994936 - ], - "translation_xyz_cm": [ - 0.3482360004180285, - -0.8011604516453996, - -5.201592358299494 - ], - "translation_norm_m": 0.052744373579735965, - "rotation_rpy_deg_xyz": [ - -0.44566905285740044, - 0.35450780958571715, - 0.08680034472550703 - ], - "rotation_angle_deg": 0.5762548463344785, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -5.779853073484276e-05, - 0.028309570664353245, - 0.06747886300866571 - ], - "translation_xyz_cm": [ - -0.005779853073484276, - 2.8309570664353245, - 6.747886300866571 - ], - "translation_norm_m": 0.0731767181883175, - "rotation_rpy_deg_xyz": [ - -0.8256077059672353, - -0.009959579152789654, - -0.7179050531309001 - ], - "rotation_angle_deg": 1.0941704852434473, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012380130415656776, - -0.04349716790005309, - -0.004004800658968339 - ], - "translation_xyz_cm": [ - 1.2380130415656776, - -4.349716790005309, - -0.40048006589683394 - ], - "translation_norm_m": 0.04540164834840418, - "rotation_rpy_deg_xyz": [ - 0.12815174377162666, - 0.1926555214552762, - -0.6298449851624468 - ], - "rotation_angle_deg": 0.671203824910437, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.01788530649481057, - -0.018157266060097488, - 0.01236713883514342 - ], - "translation_xyz_cm": [ - -1.788530649481057, - -1.8157266060097488, - 1.2367138835143419 - ], - "translation_norm_m": 0.028328724329877507, - "rotation_rpy_deg_xyz": [ - 0.5666930866394816, - -0.3480109427812121, - -0.7057018979090692 - ], - "rotation_angle_deg": 0.9684173657810848, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.010393849460006876, - 0.02185316685663885, - -0.060658654986961415 - ], - "translation_xyz_cm": [ - 1.0393849460006876, - 2.185316685663885, - -6.065865498696142 - ], - "translation_norm_m": 0.0653074684327038, - "rotation_rpy_deg_xyz": [ - 0.46659986442537754, - 0.1133091399799631, - 0.14049235731973964 - ], - "rotation_angle_deg": 0.5001626440435878, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.010299856737325697, - 0.002285430013940548, - 0.020486992999014075 - ], - "translation_xyz_cm": [ - 1.0299856737325697, - 0.2285430013940548, - 2.0486992999014078 - ], - "translation_norm_m": 0.023044025718170547, - "rotation_rpy_deg_xyz": [ - 1.1774372986719865, - 0.775502743983497, - 0.020843054001345986 - ], - "rotation_angle_deg": 1.4099092788351706, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.004326712319893566, - -0.01710099072940241, - -0.021395636555738534 - ], - "translation_xyz_cm": [ - 0.43267123198935664, - -1.710099072940241, - -2.1395636555738533 - ], - "translation_norm_m": 0.027729723890646315, - "rotation_rpy_deg_xyz": [ - -1.3982262497388969, - -1.1259285808375894, - 0.14905424095907865 - ], - "rotation_angle_deg": 1.800224630297897, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.010199510560309877, - 0.0019516484150127883, - 0.02179016493765401 - ], - "translation_xyz_cm": [ - 1.0199510560309877, - 0.19516484150127883, - 2.179016493765401 - ], - "translation_norm_m": 0.024138148960014743, - "rotation_rpy_deg_xyz": [ - -0.37632919589740205, - -0.7842516287454125, - -0.1336953761870505 - ], - "rotation_angle_deg": 0.8804742241525624, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0015364145354301861, - -0.028780801153852065, - 0.035588336561395706 - ], - "translation_xyz_cm": [ - -0.1536414535430186, - -2.8780801153852065, - 3.5588336561395706 - ], - "translation_norm_m": 0.0457954668486896, - "rotation_rpy_deg_xyz": [ - 1.3368495013325015, - -0.2935449483441324, - -0.20656643018408954 - ], - "rotation_angle_deg": 1.3836850003764836, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.001353085248701813, - 0.015290495575659424, - -0.06140454844640138 - ], - "translation_xyz_cm": [ - -0.1353085248701813, - 1.5290495575659424, - -6.1404548446401375 - ], - "translation_norm_m": 0.06329414399884059, - "rotation_rpy_deg_xyz": [ - 0.49997966135971217, - 1.4267705196344584, - 0.09663303001075173 - ], - "rotation_angle_deg": 1.5145214224117756, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009772556170556612, - 0.024657110670466498, - 0.05272739231504865 - ], - "translation_xyz_cm": [ - -0.9772556170556612, - 2.4657110670466498, - 5.272739231504866 - ], - "translation_norm_m": 0.05902248606308759, - "rotation_rpy_deg_xyz": [ - 0.37966517955751317, - 0.8924741481689585, - -0.27998386331492453 - ], - "rotation_angle_deg": 1.0102958610703667, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.002093881717442514, - -0.0350761443667047, - -0.057118462034306886 - ], - "translation_xyz_cm": [ - -0.2093881717442514, - -3.50761443667047, - -5.711846203430689 - ], - "translation_norm_m": 0.0670614565115097, - "rotation_rpy_deg_xyz": [ - 0.12032175348438785, - 0.3083633764368611, - -0.0990014549434684 - ], - "rotation_angle_deg": 0.34558737271666495, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0015250481721404974, - 0.03201431720701109, - -0.045142645175807745 - ], - "translation_xyz_cm": [ - -0.15250481721404974, - 3.201431720701109, - -4.5142645175807745 - ], - "translation_norm_m": 0.05536335152090554, - "rotation_rpy_deg_xyz": [ - 0.0769979663731691, - 1.0329896574142907, - 0.21442432714579027 - ], - "rotation_angle_deg": 1.0576743516121891, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019301680949489253, - 0.010968986980026796, - -0.07117973710234271 - ], - "translation_xyz_cm": [ - -1.9301680949489253, - 1.0968986980026796, - -7.117973710234271 - ], - "translation_norm_m": 0.07456157547156912, - "rotation_rpy_deg_xyz": [ - 0.6345384780044456, - 0.059366913438672286, - 0.36278648927039414 - ], - "rotation_angle_deg": 0.7331695785477751, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.027741789397572658, - 0.0158634848489555, - -0.07693072104329512 - ], - "translation_xyz_cm": [ - -2.774178939757266, - 1.58634848489555, - -7.693072104329513 - ], - "translation_norm_m": 0.08330421880537388, - "rotation_rpy_deg_xyz": [ - -0.0526862445905172, - 0.31253911220353925, - 0.06991131668061203 - ], - "rotation_angle_deg": 0.3245985243834573, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03347480424913718, - 0.022480588784893563, - -0.052739649119516153 - ], - "translation_xyz_cm": [ - -3.347480424913718, - 2.2480588784893563, - -5.273964911951615 - ], - "translation_norm_m": 0.06638832714328036, - "rotation_rpy_deg_xyz": [ - 0.3525477119607445, - 0.41529878905663037, - 0.31369891928337984 - ], - "rotation_angle_deg": 0.6279865278118716, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010622260356623281, - -0.013417570449218985, - -0.05648521560274062 - ], - "translation_xyz_cm": [ - -1.062226035662328, - -1.3417570449218985, - -5.648521560274062 - ], - "translation_norm_m": 0.059020701398168236, - "rotation_rpy_deg_xyz": [ - 1.2113339685776479, - 0.4487437980259796, - 0.4895185960982532 - ], - "rotation_angle_deg": 1.3797346142599807, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.016228485146855043, - -0.02109354474828562, - -0.015071900300326846 - ], - "translation_xyz_cm": [ - 1.6228485146855043, - -2.109354474828562, - -1.5071900300326846 - ], - "translation_norm_m": 0.03058534843470996, - "rotation_rpy_deg_xyz": [ - 0.052405042324071935, - -0.27601698459724455, - -0.23159909548722368 - ], - "rotation_angle_deg": 0.3640209112644816, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.009033347951899473, - 0.00027679180363793243, - -0.039668369908494455 - ], - "translation_xyz_cm": [ - -0.9033347951899473, - 0.027679180363793243, - -3.9668369908494454 - ], - "translation_norm_m": 0.04068485664371691, - "rotation_rpy_deg_xyz": [ - 0.6978611581462264, - 0.3527107698480769, - 0.2636011965722605 - ], - "rotation_angle_deg": 0.8244790019644808, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.001955301862976322, - 0.0009299321777671565, - 0.04630749387488725 - ], - "translation_xyz_cm": [ - -0.1955301862976322, - 0.09299321777671565, - 4.630749387488725 - ], - "translation_norm_m": 0.046358084173133446, - "rotation_rpy_deg_xyz": [ - 1.1608938182333444, - -0.5499443214310024, - -0.2901860375741638 - ], - "rotation_angle_deg": 1.3157027909945094, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.015928348778655455, - 0.008526825709528563, - 0.015057017915169335 - ], - "translation_xyz_cm": [ - -1.5928348778655455, - 0.8526825709528563, - 1.5057017915169335 - ], - "translation_norm_m": 0.023518776328561447, - "rotation_rpy_deg_xyz": [ - 1.1724458487610898, - 0.38454710171940987, - 0.4146672295466894 - ], - "rotation_angle_deg": 1.3004537014787487, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.009661713712372677, - -0.006681824595707653, - -0.021761677089081402 - ], - "translation_xyz_cm": [ - -0.9661713712372677, - -0.6681824595707653, - -2.17616770890814 - ], - "translation_norm_m": 0.02472986214108571, - "rotation_rpy_deg_xyz": [ - -0.24805247931709, - 0.447043033408938, - -0.296040190675037 - ], - "rotation_angle_deg": 0.5902909888369073, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.0056742357012078415, - 0.017071143034037117, - 0.12819254223858195 - ], - "translation_xyz_cm": [ - 0.5674235701207841, - 1.7071143034037117, - 12.819254223858195 - ], - "translation_norm_m": 0.12944863367711545, - "rotation_rpy_deg_xyz": [ - 1.637630152008551, - -0.38792075849245466, - -0.5054951709301369 - ], - "rotation_angle_deg": 1.755621562321663, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 7.118413944207092e-05, - 0.00435327171327371, - 0.07986877453716588 - ], - "translation_xyz_cm": [ - 0.0071184139442070915, - 0.435327171327371, - 7.9868774537165885 - ], - "translation_norm_m": 0.07998735642499967, - "rotation_rpy_deg_xyz": [ - 1.18153709530713, - 0.07856176925752208, - 0.1761950906871763 - ], - "rotation_angle_deg": 1.1970629873046432, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.0057602275134231995, - 0.01084441896066557, - 0.028276912938780915 - ], - "translation_xyz_cm": [ - 0.57602275134232, - 1.084441896066557, - 2.8276912938780914 - ], - "translation_norm_m": 0.030827997809592434, - "rotation_rpy_deg_xyz": [ - 0.851868750686325, - 0.7950709932976321, - -0.5119528344057749 - ], - "rotation_angle_deg": 1.275125522341654, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006745162771657931, - 0.04125467270476646, - 0.07315047563531167 - ], - "translation_xyz_cm": [ - -0.6745162771657931, - 4.125467270476646, - 7.315047563531167 - ], - "translation_norm_m": 0.0842522244600455, - "rotation_rpy_deg_xyz": [ - -1.156744347650714, - -0.3034026186350333, - 0.6259564042690599 - ], - "rotation_angle_deg": 1.3483621448904255, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.023036704036862865, - 0.023692203705879766, - 0.05034266378957285 - ], - "translation_xyz_cm": [ - 2.3036704036862865, - 2.3692203705879766, - 5.034266378957285 - ], - "translation_norm_m": 0.06021954870930939, - "rotation_rpy_deg_xyz": [ - -0.3157056005174438, - -0.09866317517778897, - 0.5086180088624356 - ], - "rotation_angle_deg": 0.6064812255806594, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005063438032659073, - -0.0320732619083442, - 0.005225613916701309 - ], - "translation_xyz_cm": [ - -0.5063438032659073, - -3.2073261908344195, - 0.5225613916701309 - ], - "translation_norm_m": 0.03288828932854738, - "rotation_rpy_deg_xyz": [ - 0.26841365800645883, - -0.5464657830011603, - -0.11861641353999156 - ], - "rotation_angle_deg": 0.6200292390814341, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.027919533793557827, - 0.03170394459119086, - -0.05596473657156431 - ], - "translation_xyz_cm": [ - -2.7919533793557827, - 3.170394459119086, - -5.596473657156431 - ], - "translation_norm_m": 0.0701191286983481, - "rotation_rpy_deg_xyz": [ - -0.968927217493007, - -0.8878421047793786, - -0.05527192058144169 - ], - "rotation_angle_deg": 1.3156555357860475, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00514687859906493, - 0.04122231767485118, - -0.014091611874149673 - ], - "translation_xyz_cm": [ - 0.514687859906493, - 4.122231767485118, - -1.4091611874149672 - ], - "translation_norm_m": 0.043867338180148756, - "rotation_rpy_deg_xyz": [ - -0.5783228386525223, - -0.4586973640577997, - -0.07521770584523282 - ], - "rotation_angle_deg": 0.7422025791537004, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.00019558952425713372, - -0.008273527210515608, - 0.027256014178626414 - ], - "translation_xyz_cm": [ - -0.019558952425713372, - -0.8273527210515608, - 2.7256014178626415 - ], - "translation_norm_m": 0.02848472953479856, - "rotation_rpy_deg_xyz": [ - 0.45791063284073474, - -1.087694877361352, - 0.23652966854169089 - ], - "rotation_angle_deg": 1.2044735089992442, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.019024822580292255, - 0.0025751438928436343, - 0.03781022175528575 - ], - "translation_xyz_cm": [ - -1.9024822580292255, - 0.25751438928436343, - 3.781022175528575 - ], - "translation_norm_m": 0.042405048160146355, - "rotation_rpy_deg_xyz": [ - -0.46984987433313935, - -1.0657670650363915, - 0.1772693089797356 - ], - "rotation_angle_deg": 1.1774914068251934, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0008790004859711154, - 0.020850142614959766, - -0.03910009449705604 - ], - "translation_xyz_cm": [ - 0.08790004859711154, - 2.0850142614959766, - -3.910009449705604 - ], - "translation_norm_m": 0.04432063265113902, - "rotation_rpy_deg_xyz": [ - 0.2645819013402327, - -0.3574711260848621, - 0.10593585823263997 - ], - "rotation_angle_deg": 0.45736876108030966, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.011538029433813657, - 0.020027508073980238, - -0.08108025412390138 - ], - "translation_xyz_cm": [ - 1.1538029433813657, - 2.002750807398024, - -8.108025412390138 - ], - "translation_norm_m": 0.08431034818849535, - "rotation_rpy_deg_xyz": [ - 1.096720836647421, - -0.36843441284759376, - 0.10025023977270496 - ], - "rotation_angle_deg": 1.161590777328493, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.009319546522981392, - 0.0007970056865769237, - -0.007192743340369331 - ], - "translation_xyz_cm": [ - -0.9319546522981392, - 0.07970056865769237, - -0.7192743340369332 - ], - "translation_norm_m": 0.011799352618634544, - "rotation_rpy_deg_xyz": [ - 0.3151015212894259, - -0.0962419720064821, - -0.04851449364507034 - ], - "rotation_angle_deg": 0.33298563632398753, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.016022571989968704, - 0.026194620283452874, - -0.04580312778195392 - ], - "translation_xyz_cm": [ - 1.6022571989968704, - 2.6194620283452874, - -4.580312778195392 - ], - "translation_norm_m": 0.05514351693153067, - "rotation_rpy_deg_xyz": [ - 0.8572407591137059, - 0.30869404995000804, - -0.1374420035187233 - ], - "rotation_angle_deg": 0.9217790684541854, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022703842594717027, - 0.02267431778814677, - 0.031879778615232446 - ], - "translation_xyz_cm": [ - 2.2703842594717027, - 2.267431778814677, - 3.187977861523245 - ], - "translation_norm_m": 0.04523173045860381, - "rotation_rpy_deg_xyz": [ - 1.0682532467877768, - 0.36874200627839215, - -0.08137983277095122 - ], - "rotation_angle_deg": 1.1332756409509888, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0008728645955613512, - -0.0022704633153591836, - 0.01505143892797561 - ], - "translation_xyz_cm": [ - -0.08728645955613512, - -0.22704633153591836, - 1.505143892797561 - ], - "translation_norm_m": 0.01524672784800581, - "rotation_rpy_deg_xyz": [ - 0.728632873887599, - -0.049454412865246815, - 0.00894525287981335 - ], - "rotation_angle_deg": 0.7303678615326776, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0, - "improved_pairs": 0, - "worsened_pairs": 0, - "unchanged_pairs": 80, - "median_per_pair_score_change": 0.0, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152209554813, - -6.733076264476427e-05, - 0.7182317203430111 - ], - "rotation_rpy_deg_xyz": [ - -0.7866097110824058, - 1.3026501895476275, - -0.8355419388029673 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11876672804528438, - "median": 0.061421080456601676, - "p90": 0.19375694064384466, - "p95": 0.23860051126658532, - "max": 0.386105354511038 - }, - "rotation_deg": { - "rms": 1.1650719587800913, - "median": 0.8953916046737861, - "p90": 1.753098824669132, - "p95": 2.1613437374277047, - "max": 2.8554741331695688 - }, - "normalized_pair_score": { - "rms": 3.3274291807303316, - "median": 2.592113976211846, - "p90": 5.093092739766538, - "p95": 5.846478085373832, - "max": 8.167457857841699 - }, - "normalized_global_rms": 3.3274291807303316 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018564680008689938, - 0.020901342159854064, - 0.08635710156886972 - ], - "translation_xyz_cm": [ - -1.8564680008689938, - 2.0901342159854064, - 8.635710156886972 - ], - "translation_norm_m": 0.09076928136371042, - "rotation_rpy_deg_xyz": [ - 0.39351657794723666, - 0.1009408372612325, - 0.09488353520484136 - ], - "rotation_angle_deg": 0.4171107485761563, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.661255702204205, - "median": 0.7319328700150243, - "p90": 2.3218554814672183, - "p95": 3.880978501442499, - "max": 5.5539133452469 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018564680008689938, - 0.020901342159854064, - 0.08635710156886972 - ], - "translation_xyz_cm": [ - -1.8564680008689938, - 2.0901342159854064, - 8.635710156886972 - ], - "translation_norm_m": 0.09076928136371042, - "rotation_rpy_deg_xyz": [ - 0.39351657794723666, - 0.1009408372612325, - 0.09488353520484136 - ], - "rotation_angle_deg": 0.4171107485761563, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.01907102029743324, - -0.023560410027109846, - 0.17034451028863384 - ], - "translation_xyz_cm": [ - 1.9071020297433239, - -2.3560410027109846, - 17.034451028863383 - ], - "translation_norm_m": 0.173020371405523, - "rotation_rpy_deg_xyz": [ - -0.34978257542949726, - -0.3161259781040491, - -0.35500105020341854 - ], - "rotation_angle_deg": 0.5907565710489882, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.02940848786920358, - 0.0034923371391819558, - 0.15009868303858065 - ], - "translation_xyz_cm": [ - 2.940848786920358, - 0.3492337139181956, - 15.009868303858065 - ], - "translation_norm_m": 0.15299238617448616, - "rotation_rpy_deg_xyz": [ - -0.027425245216289574, - -0.24928060967043825, - -0.3901213998393534 - ], - "rotation_angle_deg": 0.4638253750046721, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.009504769831695271, - -0.0011887791415661209, - 0.10156692903492524 - ], - "translation_xyz_cm": [ - -0.9504769831695271, - -0.11887791415661209, - 10.156692903492525 - ], - "translation_norm_m": 0.10201762062990131, - "rotation_rpy_deg_xyz": [ - 0.6559402255486372, - 0.15111561065180218, - 0.2053023020700171 - ], - "rotation_angle_deg": 0.7034817917716983, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.01951168822335636, - -0.004406907351854894, - -0.02662389310617338 - ], - "translation_xyz_cm": [ - -1.951168822335636, - -0.4406907351854894, - -2.6623893106173377 - ], - "translation_norm_m": 0.03330102842048939, - "rotation_rpy_deg_xyz": [ - 0.6686016948971264, - -0.05029943726456191, - 0.060630233742691046 - ], - "rotation_angle_deg": 0.6732531484286871, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.030813647132088007, - -0.01800624042898802, - 0.07409032235053005 - ], - "translation_xyz_cm": [ - 3.0813647132088007, - -1.8006240428988018, - 7.409032235053005 - ], - "translation_norm_m": 0.0822379560177222, - "rotation_rpy_deg_xyz": [ - 0.3852245185577911, - 0.06477760111482718, - -0.3437164079841011 - ], - "rotation_angle_deg": 0.5204654274114823, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.042460412197253494, - 0.006255065884180455, - 0.06440755777113724 - ], - "translation_xyz_cm": [ - 4.246041219725349, - 0.6255065884180455, - 6.440755777113724 - ], - "translation_norm_m": 0.07739732522005197, - "rotation_rpy_deg_xyz": [ - 0.7262203301510765, - 0.3765839448838049, - -0.359604281554092 - ], - "rotation_angle_deg": 0.8945608053223414, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00020197118811354775, - -0.005523982955361273, - 0.0006049985980472392 - ], - "translation_xyz_cm": [ - 0.020197118811354775, - -0.5523982955361273, - 0.060499859804723916 - ], - "translation_norm_m": 0.005560683712960933, - "rotation_rpy_deg_xyz": [ - 1.0385730321488, - 0.3223172961874696, - 0.024880859272443483 - ], - "rotation_angle_deg": 1.087654913261944, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004968777432973749, - 0.01923488463531542, - 0.0015084757399807002 - ], - "translation_xyz_cm": [ - 0.4968777432973749, - 1.923488463531542, - 0.15084757399807003 - ], - "translation_norm_m": 0.019923479494567024, - "rotation_rpy_deg_xyz": [ - 0.363195323700103, - 0.23836580551750317, - -0.024661206731084462 - ], - "rotation_angle_deg": 0.4351716272675689, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.038960035651808, - -0.0031488825072770177, - -0.03511303170061648 - ], - "translation_xyz_cm": [ - -3.8960035651808003, - -0.31488825072770177, - -3.5113031700616477 - ], - "translation_norm_m": 0.05254260018540464, - "rotation_rpy_deg_xyz": [ - 0.7811045490016015, - 0.9133856214731788, - 0.578074597558221 - ], - "rotation_angle_deg": 1.3309186547462473, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.05024397705594788, - -0.026016920412933797, - -0.04429176337266186 - ], - "translation_xyz_cm": [ - -5.024397705594788, - -2.6016920412933797, - -4.429176337266186 - ], - "translation_norm_m": 0.07185469839079014, - "rotation_rpy_deg_xyz": [ - 0.8817633882209501, - 1.4735506165931334, - 0.4962484754018556 - ], - "rotation_angle_deg": 1.784322194860478, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03328349619246811, - -0.020572077059866523, - -0.043188589454507514 - ], - "translation_xyz_cm": [ - -3.3283496192468105, - -2.0572077059866523, - -4.318858945450751 - ], - "translation_norm_m": 0.05827740327452076, - "rotation_rpy_deg_xyz": [ - 0.5786869162666212, - 0.4931604496438409, - 0.5994625776390419 - ], - "rotation_angle_deg": 0.9666684768958944, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0405019777058601, - -0.041268507261061516, - -0.052081583244642626 - ], - "translation_xyz_cm": [ - -4.05019777058601, - -4.126850726106151, - -5.208158324464263 - ], - "translation_norm_m": 0.07782024931154433, - "rotation_rpy_deg_xyz": [ - 0.813987564980703, - 1.01722922940716, - 0.519991563497545 - ], - "rotation_angle_deg": 1.40006376899004, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01251696239840027, - -0.01344046264426127, - -0.009758201221696253 - ], - "translation_xyz_cm": [ - -1.251696239840027, - -1.3440462644261268, - -0.9758201221696252 - ], - "translation_norm_m": 0.020797665129957812, - "rotation_rpy_deg_xyz": [ - 0.4192484071914317, - 0.355110149518721, - -0.08625329485627341 - ], - "rotation_angle_deg": 0.5563592185095552, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009483332641595621, - -0.013350195165535983, - -0.19159097837627279 - ], - "translation_xyz_cm": [ - 0.9483332641595621, - -1.3350195165535983, - -19.15909783762728 - ], - "translation_norm_m": 0.1922895324871494, - "rotation_rpy_deg_xyz": [ - -0.7759244394848984, - 0.13882250632014834, - 0.33309209689268826 - ], - "rotation_angle_deg": 0.8560986719045488, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00035143916005220266, - 0.009399790123171629, - -0.23683367758906743 - ], - "translation_xyz_cm": [ - 0.035143916005220266, - 0.9399790123171629, - -23.683367758906744 - ], - "translation_norm_m": 0.23702040081859035, - "rotation_rpy_deg_xyz": [ - -0.4705528258243853, - -0.17784252183877722, - 0.4336909465296689 - ], - "rotation_angle_deg": 0.6637024492160325, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.004992427518511144, - 0.00030420017614918304, - -0.022405907640905068 - ], - "translation_xyz_cm": [ - -0.49924275185111444, - 0.030420017614918304, - -2.240590764090507 - ], - "translation_norm_m": 0.02295738590274434, - "rotation_rpy_deg_xyz": [ - 0.22076111142443447, - 0.018413495164625947, - -0.09545659871558558 - ], - "rotation_angle_deg": 0.2412327672225137, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0016346400536259992, - 0.026235413022170695, - -0.26733338276328106 - ], - "translation_xyz_cm": [ - 0.16346400536259992, - 2.6235413022170695, - -26.733338276328105 - ], - "translation_norm_m": 0.26862260977849156, - "rotation_rpy_deg_xyz": [ - -0.5384267302340613, - 0.05372346428424111, - 0.07064074162093717 - ], - "rotation_angle_deg": 0.5457245403443411, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0021702725724659366, - 0.01435713551458806, - -0.16430377408317862 - ], - "translation_xyz_cm": [ - -0.21702725724659366, - 1.435713551458806, - -16.430377408317863 - ], - "translation_norm_m": 0.16494413478871942, - "rotation_rpy_deg_xyz": [ - -0.4888457698906788, - 0.742613121943745, - 0.27717674466749215 - ], - "rotation_angle_deg": 0.9322138568644655, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.006585073742727876, - 0.025855489984468738, - 0.007696237165088993 - ], - "translation_xyz_cm": [ - 0.6585073742727876, - 2.585548998446874, - 0.7696237165088993 - ], - "translation_norm_m": 0.027768716661657672, - "rotation_rpy_deg_xyz": [ - 0.3435883088880187, - -0.7901358184613355, - -0.24905862858512676 - ], - "rotation_angle_deg": 0.8962224040252308, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014248602835950752, - -0.028743632155298852, - -0.02228566298118005 - ], - "translation_xyz_cm": [ - -1.4248602835950752, - -2.8743632155298853, - -2.228566298118005 - ], - "translation_norm_m": 0.0390623840384395, - "rotation_rpy_deg_xyz": [ - 0.11565076840856509, - -0.3259969687692465, - -0.47898613039532406 - ], - "rotation_angle_deg": 0.5905598372404788, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004959803253516193, - 0.007494108505724073, - -0.0042021805264075215 - ], - "translation_xyz_cm": [ - 0.4959803253516193, - 0.7494108505724073, - -0.4202180526407522 - ], - "translation_norm_m": 0.009920666902263895, - "rotation_rpy_deg_xyz": [ - 0.5093088910709729, - -0.574928339199577, - -0.48110915589306025 - ], - "rotation_angle_deg": 0.9049529047498361, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.019385329694399656, - 0.01033826341325339, - -0.20579423423549162 - ], - "translation_xyz_cm": [ - -1.9385329694399656, - 1.033826341325339, - -20.579423423549162 - ], - "translation_norm_m": 0.20696361405410077, - "rotation_rpy_deg_xyz": [ - -0.5569325918145851, - 1.0558800323857225, - -0.638662219143969 - ], - "rotation_angle_deg": 1.3514316687931252, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.028909685733032778, - 0.023761359135177074, - -0.2290605588293393 - ], - "translation_xyz_cm": [ - -2.8909685733032777, - 2.3761359135177074, - -22.906055882933927 - ], - "translation_norm_m": 0.2320972031894025, - "rotation_rpy_deg_xyz": [ - -0.07013619809679611, - 0.9584927545348267, - -0.40838904251578445 - ], - "rotation_angle_deg": 1.043995148246985, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.0112808684186404, - 0.02993943710558833, - -0.03635270912005325 - ], - "translation_xyz_cm": [ - 1.12808684186404, - 2.993943710558833, - -3.635270912005325 - ], - "translation_norm_m": 0.048426721413341214, - "rotation_rpy_deg_xyz": [ - 0.37291904312552987, - -0.11033271525610892, - -0.011410150484277355 - ], - "rotation_angle_deg": 0.3890551053497429, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012199167741719252, - 0.043799483907421166, - -0.13767153933600193 - ], - "translation_xyz_cm": [ - 1.2199167741719252, - 4.379948390742117, - -13.767153933600193 - ], - "translation_norm_m": 0.14498505863464475, - "rotation_rpy_deg_xyz": [ - -0.48243662792349357, - -0.2647102518337062, - 0.16389681227775177 - ], - "rotation_angle_deg": 0.5738578693461874, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005586807557785456, - 0.018101648839009887, - -0.0879979806976156 - ], - "translation_xyz_cm": [ - 0.5586807557785456, - 1.8101648839009887, - -8.79979806976156 - ], - "translation_norm_m": 0.09001403621789483, - "rotation_rpy_deg_xyz": [ - -0.7226183783620622, - -0.13724999308625818, - 0.1624141562264191 - ], - "rotation_angle_deg": 0.7530680497547391, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.010537060586258029, - -0.025908858452496464, - -0.16809392109385693 - ], - "translation_xyz_cm": [ - -1.053706058625803, - -2.5908858452496464, - -16.809392109385694 - ], - "translation_norm_m": 0.1704050025698124, - "rotation_rpy_deg_xyz": [ - -0.7906134718434713, - 2.2809008704478133, - -0.37195132541154236 - ], - "rotation_angle_deg": 2.4401058428197016, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.0038912027572898245, - 0.020317931400214095, - -0.022532451922345598 - ], - "translation_xyz_cm": [ - 0.38912027572898245, - 2.0317931400214095, - -2.2532451922345595 - ], - "translation_norm_m": 0.030588742780882017, - "rotation_rpy_deg_xyz": [ - 1.0363346090863275, - 0.09872520358307181, - 0.22010716055923873 - ], - "rotation_angle_deg": 1.0638555394651712, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.007269743371432158, - 0.03548411414423036, - 0.0564888179857735 - ], - "translation_xyz_cm": [ - 0.7269743371432158, - 3.548411414423036, - 5.64888179857735 - ], - "translation_norm_m": 0.0671040839496159, - "rotation_rpy_deg_xyz": [ - 1.2113167693212532, - 1.5909172146099273, - 0.15644124479198548 - ], - "rotation_angle_deg": 2.0043505704376194, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.013077359716803016, - 0.003230495500305519, - -0.028442524738164575 - ], - "translation_xyz_cm": [ - -1.3077359716803016, - 0.3230495500305519, - -2.8442524738164576 - ], - "translation_norm_m": 0.03147110820770791, - "rotation_rpy_deg_xyz": [ - -0.013709684586770363, - 2.44507265945059, - 0.6926273561333641 - ], - "rotation_angle_deg": 2.541384132227667, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.009264647698670081, - -0.00020628180913440097, - 0.38599413017937084 - ], - "translation_xyz_cm": [ - 0.9264647698670081, - -0.020628180913440097, - 38.59941301793708 - ], - "translation_norm_m": 0.386105354511038, - "rotation_rpy_deg_xyz": [ - -1.1923635713588268, - 0.5866233667901987, - -0.06354516233448708 - ], - "rotation_angle_deg": 1.3300780002299097, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010995945304964394, - 0.03651258449529038, - 0.0468696382385419 - ], - "translation_xyz_cm": [ - 1.0995945304964394, - 3.651258449529038, - 4.68696382385419 - ], - "translation_norm_m": 0.060422203106865253, - "rotation_rpy_deg_xyz": [ - 1.4538700124506527, - -0.3664185843322303, - 0.05766078938056496 - ], - "rotation_angle_deg": 1.50061790058412, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.006690174582106412, - 0.015451330468113866, - 0.002603870063770726 - ], - "translation_xyz_cm": [ - -0.6690174582106412, - 1.5451330468113866, - 0.26038700637707257 - ], - "translation_norm_m": 0.01703766969051014, - "rotation_rpy_deg_xyz": [ - 0.19424681229901322, - 2.082047152469456, - 0.48890737702173437 - ], - "rotation_angle_deg": 2.146672047670232, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.02989478242888699, - 0.022288796422304635, - 0.1481182333930855 - ], - "translation_xyz_cm": [ - 2.989478242888699, - 2.2288796422304635, - 14.81182333930855 - ], - "translation_norm_m": 0.15273997356918056, - "rotation_rpy_deg_xyz": [ - 0.035310658898615316, - -0.7692798668737805, - -0.296229082320204 - ], - "rotation_angle_deg": 0.8250140872903372, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.005509272468109422, - 0.008628023947647723, - 0.38558368374235463 - ], - "translation_xyz_cm": [ - 0.5509272468109422, - 0.8628023947647723, - 38.558368374235464 - ], - "translation_norm_m": 0.38571955103247385, - "rotation_rpy_deg_xyz": [ - -0.4942923024613264, - 0.5379718177739625, - -0.243496911053386 - ], - "rotation_angle_deg": 0.7693481730362326, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01626689090504274, - 0.010424587752599856, - 0.058135164214924526 - ], - "translation_xyz_cm": [ - -1.6266890905042741, - 1.0424587752599856, - 5.813516421492452 - ], - "translation_norm_m": 0.06126157921425515, - "rotation_rpy_deg_xyz": [ - 0.9710568926745989, - 2.623394769874062, - 0.596086603961247 - ], - "rotation_angle_deg": 2.8554741331695688, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03244354069995958, - 0.0019835958810203724, - 0.18406103056047474 - ], - "translation_xyz_cm": [ - 3.2443540699959583, - 0.19835958810203724, - 18.406103056047474 - ], - "translation_norm_m": 0.18690901785829692, - "rotation_rpy_deg_xyz": [ - 0.352260978525091, - -0.21164193181763888, - -0.22359798786500126 - ], - "rotation_angle_deg": 0.46753060181683515, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03591619726651141, - 0.008476495496088532, - 0.31559154239887066 - ], - "translation_xyz_cm": [ - 3.5916197266511407, - 0.8476495496088532, - 31.559154239887064 - ], - "translation_norm_m": 0.317741791138151, - "rotation_rpy_deg_xyz": [ - 0.17786259455157707, - 0.05413511000957102, - -0.23587988705994126 - ], - "rotation_angle_deg": 0.3004074274464482, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.027118361749626008, - 0.018773643116250183, - 0.07195246662490198 - ], - "translation_xyz_cm": [ - 2.7118361749626008, - 1.8773643116250183, - 7.195246662490199 - ], - "translation_norm_m": 0.07915183303782383, - "rotation_rpy_deg_xyz": [ - 0.9202707496567123, - -2.3634741985965464, - -0.7919259332516597 - ], - "rotation_angle_deg": 2.6513713418290195, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012326766770772934, - 0.02509257611316107, - 0.20671809033609234 - ], - "translation_xyz_cm": [ - -1.2326766770772934, - 2.509257611316107, - 20.671809033609236 - ], - "translation_norm_m": 0.2085999890393493, - "rotation_rpy_deg_xyz": [ - 0.7275343231740734, - -0.7167626382329404, - -0.7340200609400214 - ], - "rotation_angle_deg": 1.2550452472887221, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0031777416478508957, - -0.0210651069297223, - 0.16443130513837179 - ], - "translation_xyz_cm": [ - -0.3177741647850896, - -2.10651069297223, - 16.44313051383718 - ], - "translation_norm_m": 0.16580558157507683, - "rotation_rpy_deg_xyz": [ - -1.004380047144114, - 0.5117044117312906, - -0.02528848452430416 - ], - "rotation_angle_deg": 1.1273981669706314, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0039517155086261635, - -0.008841520838812844, - -0.056120324788169404 - ], - "translation_xyz_cm": [ - 0.39517155086261635, - -0.8841520838812844, - -5.61203247881694 - ], - "translation_norm_m": 0.05694979719484433, - "rotation_rpy_deg_xyz": [ - -0.37539373619625593, - 0.38481940728019026, - 0.08853541679410887 - ], - "rotation_angle_deg": 0.5450390709798789, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.00027895640991015824, - 0.027593742961863565, - 0.06128858044715662 - ], - "translation_xyz_cm": [ - 0.027895640991015824, - 2.7593742961863565, - 6.1288580447156615 - ], - "translation_norm_m": 0.0672144520215081, - "rotation_rpy_deg_xyz": [ - -0.7698951502356677, - 0.0079935939620499, - -0.7166905367484767 - ], - "rotation_angle_deg": 1.051837940983248, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012855336712754628, - -0.044454859228982624, - -0.003311891595811558 - ], - "translation_xyz_cm": [ - 1.2855336712754628, - -4.445485922898262, - -0.3311891595811558 - ], - "translation_norm_m": 0.04639464211532799, - "rotation_rpy_deg_xyz": [ - 0.20518333586257514, - 0.23066161043742653, - -0.627528603511413 - ], - "rotation_angle_deg": 0.6997245706083717, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.016292759661860945, - -0.01673251148268262, - 0.008385195411012174 - ], - "translation_xyz_cm": [ - -1.6292759661860945, - -1.6732511482682622, - 0.8385195411012174 - ], - "translation_norm_m": 0.024814158458390818, - "rotation_rpy_deg_xyz": [ - 0.46648300444396795, - -0.23238807338566403, - -0.7052648138010384 - ], - "rotation_angle_deg": 0.876168340425795, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.010683828949729968, - 0.020915696838273767, - -0.058806951639554045 - ], - "translation_xyz_cm": [ - 1.0683828949729968, - 2.0915696838273767, - -5.880695163955404 - ], - "translation_norm_m": 0.0633235196147096, - "rotation_rpy_deg_xyz": [ - 0.535212587321076, - 0.14192431841669373, - 0.14263571974261763 - ], - "rotation_angle_deg": 0.5716210026845987, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.011435402133669836, - 0.0037404184081744063, - 0.015843662014803417 - ], - "translation_xyz_cm": [ - 1.1435402133669836, - 0.37404184081744063, - 1.5843662014803417 - ], - "translation_norm_m": 0.019894239816245187, - "rotation_rpy_deg_xyz": [ - 1.0767419148979256, - 0.8634697786510559, - 0.021577923985353693 - ], - "rotation_angle_deg": 1.3802342946026664, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.004264828902144302, - -0.017696609560297782, - -0.015002235133701025 - ], - "translation_xyz_cm": [ - 0.4264828902144302, - -1.7696609560297782, - -1.5002235133701025 - ], - "translation_norm_m": 0.023588679795635906, - "rotation_rpy_deg_xyz": [ - -1.3455700269026873, - -1.1100007092147588, - 0.1500434009925138 - ], - "rotation_angle_deg": 1.7496295613145376, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.011090896570647768, - 0.0006206371543608091, - 0.02260001717074625 - ], - "translation_xyz_cm": [ - 1.1090896570647768, - 0.06206371543608091, - 2.260001717074625 - ], - "translation_norm_m": 0.025182413572495486, - "rotation_rpy_deg_xyz": [ - -0.2807935663989772, - -0.7083843283324291, - -0.13099972450012481 - ], - "rotation_angle_deg": 0.7734777544851904, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0011487542629260439, - -0.028891320085786765, - 0.030410314983735642 - ], - "translation_xyz_cm": [ - 0.11487542629260439, - -2.8891320085786765, - 3.041031498373564 - ], - "translation_norm_m": 0.0419620694206803, - "rotation_rpy_deg_xyz": [ - 1.3587469040746847, - -0.09648348599551648, - -0.19874474875851886 - ], - "rotation_angle_deg": 1.3764245890315718, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -6.7948970459696945e-06, - 0.016665306801816104, - -0.06799714464535159 - ], - "translation_xyz_cm": [ - -0.0006794897045969694, - 1.6665306801816104, - -6.799714464535159 - ], - "translation_norm_m": 0.07000960060513237, - "rotation_rpy_deg_xyz": [ - 0.39902727809351807, - 1.5365439776087852, - 0.09679226002722972 - ], - "rotation_angle_deg": 1.5901298651050115, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00948355112053445, - 0.023818987586956997, - 0.047582123224519206 - ], - "translation_xyz_cm": [ - -0.948355112053445, - 2.3818987586956997, - 4.758212322451921 - ], - "translation_norm_m": 0.05404942517804173, - "rotation_rpy_deg_xyz": [ - 0.447821015823132, - 0.9206194760172061, - -0.2779042945085865 - ], - "rotation_angle_deg": 1.0617476039092562, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.000785873930166936, - -0.03623941581040524, - -0.058934151060732125 - ], - "translation_xyz_cm": [ - -0.0785873930166936, - -3.623941581040524, - -5.8934151060732125 - ], - "translation_norm_m": 0.0691892117122515, - "rotation_rpy_deg_xyz": [ - 0.21884014604766314, - 0.4104972308661143, - -0.09514402620648407 - ], - "rotation_angle_deg": 0.4749739911158604, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0008142853307691045, - 0.03226063956626746, - -0.04820106480525671 - ], - "translation_xyz_cm": [ - 0.08142853307691045, - 3.2260639566267457, - -4.820106480525671 - ], - "translation_norm_m": 0.05800650458513325, - "rotation_rpy_deg_xyz": [ - 0.059640110551126384, - 1.231681631840971, - 0.2170065549737068 - ], - "rotation_angle_deg": 1.2519617629733422, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018610048066026952, - 0.011980165353442374, - -0.07400017734968606 - ], - "translation_xyz_cm": [ - -1.8610048066026952, - 1.1980165353442374, - -7.400017734968606 - ], - "translation_norm_m": 0.07723913838657603, - "rotation_rpy_deg_xyz": [ - 0.5499818882207399, - 0.10378675506445974, - 0.36200566648398125 - ], - "rotation_angle_deg": 0.6662867986626463, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.026970148167100527, - 0.014772490130086968, - -0.07422019461932593 - ], - "translation_xyz_cm": [ - -2.6970148167100527, - 1.4772490130086968, - -7.422019461932592 - ], - "translation_norm_m": 0.08033836347679414, - "rotation_rpy_deg_xyz": [ - 0.03832010919023381, - 0.37442442192878556, - 0.07274228996444668 - ], - "rotation_angle_deg": 0.38332137809782924, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0320552361805817, - 0.021358445392014258, - -0.05163868897904586 - ], - "translation_xyz_cm": [ - -3.2055236180581703, - 2.135844539201426, - -5.163868897904586 - ], - "translation_norm_m": 0.06442263232460439, - "rotation_rpy_deg_xyz": [ - 0.44993739370807434, - 0.5304465477243525, - 0.31821439116747957 - ], - "rotation_angle_deg": 0.7640349293739054, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00836978106108699, - -0.012636068511780563, - -0.059686217671552036 - ], - "translation_xyz_cm": [ - -0.8369781061086989, - -1.2636068511780563, - -5.968621767155204 - ], - "translation_norm_m": 0.06158058169894819, - "rotation_rpy_deg_xyz": [ - 1.154949598923826, - 0.6321919390003476, - 0.49459096683858556 - ], - "rotation_angle_deg": 1.4042322889299448, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.018132784901456533, - -0.019968371611933877, - -0.018864740190395374 - ], - "translation_xyz_cm": [ - 1.8132784901456533, - -1.9968371611933877, - -1.8864740190395375 - ], - "translation_norm_m": 0.032915227107919144, - "rotation_rpy_deg_xyz": [ - -0.03792847099673736, - -0.13021709129373585, - -0.2315561841732556 - ], - "rotation_angle_deg": 0.268390128078722, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008799045210541867, - -0.000318893378331353, - -0.04111516842713925 - ], - "translation_xyz_cm": [ - -0.8799045210541867, - -0.0318893378331353, - -4.111516842713925 - ], - "translation_norm_m": 0.042047377616159745, - "rotation_rpy_deg_xyz": [ - 0.749350716414566, - 0.3678345329577748, - 0.2651258369234198 - ], - "rotation_angle_deg": 0.8751238864465289, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00016263146632233827, - -0.0003162700666194951, - 0.0513571576992713 - ], - "translation_xyz_cm": [ - -0.016263146632233827, - -0.03162700666194951, - 5.13571576992713 - ], - "translation_norm_m": 0.051358389019679145, - "rotation_rpy_deg_xyz": [ - 1.2434308705549044, - -0.3959664750510224, - -0.28303377470489893 - ], - "rotation_angle_deg": 1.3343822916744814, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.013582817627829868, - 0.007988137992797961, - 0.011752904348376766 - ], - "translation_xyz_cm": [ - -1.3582817627829868, - 0.7988137992797961, - 1.1752904348376767 - ], - "translation_norm_m": 0.0196579257279338, - "rotation_rpy_deg_xyz": [ - 1.2261266686304344, - 0.5678433739977715, - 0.42219396605912596 - ], - "rotation_angle_deg": 1.4138350181302302, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.007050791232579456, - -0.006714979187704362, - -0.02739183506925448 - ], - "translation_xyz_cm": [ - -0.7050791232579456, - -0.6714979187704362, - -2.739183506925448 - ], - "translation_norm_m": 0.02907090007134216, - "rotation_rpy_deg_xyz": [ - -0.24244244014260077, - 0.6467735031871835, - -0.2940331645050329 - ], - "rotation_angle_deg": 0.7501622696467056, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.006818357855136625, - 0.015562028951449758, - 0.13305111899061947 - ], - "translation_xyz_cm": [ - 0.6818357855136625, - 1.5562028951449758, - 13.305111899061947 - ], - "translation_norm_m": 0.13413152878269316, - "rotation_rpy_deg_xyz": [ - 1.736068505780735, - -0.28524910491539235, - -0.49890592668522454 - ], - "rotation_angle_deg": 1.8275311667939402, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0018672014644804946, - 0.003214233439909231, - 0.08028890877604433 - ], - "translation_xyz_cm": [ - 0.18672014644804946, - 0.3214233439909231, - 8.028890877604432 - ], - "translation_norm_m": 0.08037491281714187, - "rotation_rpy_deg_xyz": [ - 1.2703830422289348, - 0.22134390252047256, - 0.18315426131999646 - ], - "rotation_angle_deg": 1.302117271190918, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008092530291345934, - 0.010136373387671815, - 0.026505835094345634 - ], - "translation_xyz_cm": [ - 0.8092530291345934, - 1.0136373387671815, - 2.6505835094345636 - ], - "translation_norm_m": 0.029509225778039272, - "rotation_rpy_deg_xyz": [ - 0.9081117468421843, - 0.9766830225830108, - -0.5054420624654055 - ], - "rotation_angle_deg": 1.4289300465734152, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006831161382622852, - 0.0419441853261715, - 0.07969674055513211 - ], - "translation_xyz_cm": [ - -0.6831161382622852, - 4.19441853261715, - 7.969674055513211 - ], - "translation_norm_m": 0.09031915579556585, - "rotation_rpy_deg_xyz": [ - -1.2058356498072815, - -0.29133795032897764, - 0.624799517507476 - ], - "rotation_angle_deg": 1.3876031667808832, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.023742579179035772, - 0.02492019321440697, - 0.05740785600727712 - ], - "translation_xyz_cm": [ - 2.374257917903577, - 2.492019321440697, - 5.740785600727712 - ], - "translation_norm_m": 0.06693570069304139, - "rotation_rpy_deg_xyz": [ - -0.4129165933576217, - -0.02741114212236338, - 0.5070165191473925 - ], - "rotation_angle_deg": 0.6543821169192781, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004771343275534967, - -0.031224328935051893, - 0.0073422012936083525 - ], - "translation_xyz_cm": [ - -0.4771343275534967, - -3.1224328935051893, - 0.7342201293608352 - ], - "translation_norm_m": 0.032428881478293016, - "rotation_rpy_deg_xyz": [ - 0.19751893607932014, - -0.5183897957494993, - -0.11966782699716144 - ], - "rotation_angle_deg": 0.5673163720448134, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.025641249110442743, - 0.03206403318672191, - -0.05245972316444224 - ], - "translation_xyz_cm": [ - -2.5641249110442743, - 3.2064033186721907, - -5.245972316444224 - ], - "translation_norm_m": 0.06661530180546285, - "rotation_rpy_deg_xyz": [ - -0.9981870506815148, - -0.6918057487167906, - -0.056588603285745796 - ], - "rotation_angle_deg": 1.2160775696832837, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.007448467010013893, - 0.04102071183435918, - -0.008552199504963096 - ], - "translation_xyz_cm": [ - 0.7448467010013893, - 4.102071183435918, - -0.8552199504963096 - ], - "translation_norm_m": 0.04255958853853608, - "rotation_rpy_deg_xyz": [ - -0.5636743033200866, - -0.26001791732933477, - -0.07415209589085758 - ], - "rotation_angle_deg": 0.62532044305067, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -4.1542659585225294e-05, - -0.007540382429269854, - 0.029871843043389024 - ], - "translation_xyz_cm": [ - -0.0041542659585225294, - -0.7540382429269854, - 2.9871843043389026 - ], - "translation_norm_m": 0.030808863980696793, - "rotation_rpy_deg_xyz": [ - 0.3952204838861507, - -1.066717122449236, - 0.23560198563989992 - ], - "rotation_angle_deg": 1.162462986554775, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01784811202563752, - 0.0038236441187231573, - 0.038547509134463524 - ], - "translation_xyz_cm": [ - -1.784811202563752, - 0.38236441187231573, - 3.8547509134463525 - ], - "translation_norm_m": 0.04265074228777152, - "rotation_rpy_deg_xyz": [ - -0.5711804503146022, - -0.9695622519966849, - 0.17549815485577064 - ], - "rotation_angle_deg": 1.1381531570246164, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.002673222778931117, - 0.02189283074090642, - -0.037558007715184485 - ], - "translation_xyz_cm": [ - 0.2673222778931117, - 2.189283074090642, - -3.7558007715184485 - ], - "translation_norm_m": 0.043555092714969976, - "rotation_rpy_deg_xyz": [ - 0.17568785016344207, - -0.20897473275206607, - 0.10659945154512371 - ], - "rotation_angle_deg": 0.29320360569028786, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.013729344759571882, - 0.020690393841815924, - -0.07888955684449382 - ], - "translation_xyz_cm": [ - 1.3729344759571882, - 2.0690393841815924, - -7.888955684449382 - ], - "translation_norm_m": 0.08270519623323108, - "rotation_rpy_deg_xyz": [ - 1.0371010400773066, - -0.18714570055169352, - 0.10481085480208643 - ], - "rotation_angle_deg": 1.0592172467557375, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.008859298471898036, - 0.0017526981063185065, - -0.007513164604876152 - ], - "translation_xyz_cm": [ - -0.8859298471898036, - 0.17526981063185065, - -0.7513164604876152 - ], - "translation_norm_m": 0.011747627949762078, - "rotation_rpy_deg_xyz": [ - 0.23795297284091274, - -0.06155695438146469, - -0.04955855952024645 - ], - "rotation_angle_deg": 0.25070749467195586, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.017126465973758886, - 0.027470229204423324, - -0.0486267497234328 - ], - "translation_xyz_cm": [ - 1.7126465973758886, - 2.7470229204423324, - -4.86267497234328 - ], - "translation_norm_m": 0.05841652264521781, - "rotation_rpy_deg_xyz": [ - 0.7572095660706087, - 0.39202359869235714, - -0.1373126201527657 - ], - "rotation_angle_deg": 0.8640673604754165, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022981981776984295, - 0.023469695410797353, - 0.02688816800218331 - ], - "translation_xyz_cm": [ - 2.2981981776984295, - 2.3469695410797353, - 2.688816800218331 - ], - "translation_norm_m": 0.042449636836925646, - "rotation_rpy_deg_xyz": [ - 1.0162772135152411, - 0.38246373717303117, - -0.08207888733598163 - ], - "rotation_angle_deg": 1.0892142155619826, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0007294158109432125, - -0.001660236440746976, - 0.012784444789278643 - ], - "translation_xyz_cm": [ - -0.07294158109432125, - -0.1660236440746976, - 1.2784444789278644 - ], - "translation_norm_m": 0.012912414996217864, - "rotation_rpy_deg_xyz": [ - 0.6855636888338226, - -0.040370064627558176, - 0.008239918754199264 - ], - "rotation_angle_deg": 0.6868035889494507, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.031193563505596433, - "improved_pairs": 37, - "worsened_pairs": 43, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.027643515853556178, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667926374616, - -6.733076264476427e-05, - 0.7159634183009542 - ], - "rotation_rpy_deg_xyz": [ - -0.7880683915167217, - 1.4026395561702687, - -0.8355763723005772 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11886418170047355, - "median": 0.06132929601089313, - "p90": 0.1935495285119641, - "p95": 0.2391682026871025, - "max": 0.3849577361584619 - }, - "rotation_deg": { - "rms": 1.2000618469690334, - "median": 0.9259085233145355, - "p90": 1.7169215862212959, - "p95": 2.275805623801523, - "max": 2.9592572905732757 - }, - "normalized_pair_score": { - "rms": 3.378175724075376, - "median": 2.553915837445401, - "p90": 5.308237523689919, - "p95": 6.006579844415096, - "max": 8.211326239421902 - }, - "normalized_global_rms": 3.378175724075376 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018640860826090344, - 0.020601695863731395, - 0.08543092565116833 - ], - "translation_xyz_cm": [ - -1.8640860826090344, - 2.0601695863731395, - 8.543092565116833 - ], - "translation_norm_m": 0.0898351524872909, - "rotation_rpy_deg_xyz": [ - 0.41630258905629564, - 0.10390311519273844, - 0.09548331182797956 - ], - "rotation_angle_deg": 0.4394867360130287, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6622470214176333, - "median": 0.7148339614213655, - "p90": 2.277662858258894, - "p95": 3.7960285397867324, - "max": 5.579952273463167 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018640860826090344, - 0.020601695863731395, - 0.08543092565116833 - ], - "translation_xyz_cm": [ - -1.8640860826090344, - 2.0601695863731395, - 8.543092565116833 - ], - "translation_norm_m": 0.0898351524872909, - "rotation_rpy_deg_xyz": [ - 0.41630258905629564, - 0.10390311519273844, - 0.09548331182797956 - ], - "rotation_angle_deg": 0.4394867360130287, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019069665155883375, - -0.024197843367239624, - 0.16808410008862212 - ], - "translation_xyz_cm": [ - 1.9069665155883375, - -2.4197843367239624, - 16.80841000886221 - ], - "translation_norm_m": 0.17088432477961493, - "rotation_rpy_deg_xyz": [ - -0.3056397816472577, - -0.3051333130508888, - -0.353870348628506 - ], - "rotation_angle_deg": 0.5588572473294783, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.029630092751468218, - 0.0025395470443903, - 0.14757402026946226 - ], - "translation_xyz_cm": [ - 2.9630092751468218, - 0.25395470443903, - 14.757402026946226 - ], - "translation_norm_m": 0.15054063622206112, - "rotation_rpy_deg_xyz": [ - 0.03874801212766675, - -0.22295239175181303, - -0.38819411263297876 - ], - "rotation_angle_deg": 0.44927176348686476, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.008632948595368069, - -0.0024363084023697468, - 0.09865466404310824 - ], - "translation_xyz_cm": [ - -0.8632948595368068, - -0.24363084023697468, - 9.865466404310824 - ], - "translation_norm_m": 0.09906162797743776, - "rotation_rpy_deg_xyz": [ - 0.7494468879993077, - 0.21973264262022937, - 0.2092955444664139 - ], - "rotation_angle_deg": 0.8081799174530996, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.018178650603644986, - -0.0056916177103067955, - -0.029927765245118643 - ], - "translation_xyz_cm": [ - -1.8178650603644986, - -0.5691617710306796, - -2.9927765245118643 - ], - "translation_norm_m": 0.03547575203567377, - "rotation_rpy_deg_xyz": [ - 0.7671157983744492, - 0.049783445200028406, - 0.06558704744030648 - ], - "rotation_angle_deg": 0.7714939291273722, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.030792390479465803, - -0.018284248772790113, - 0.07281685385820538 - ], - "translation_xyz_cm": [ - 3.0792390479465803, - -1.8284248772790113, - 7.281685385820539 - ], - "translation_norm_m": 0.08114665286031465, - "rotation_rpy_deg_xyz": [ - 0.4078571674717513, - 0.06770192914489348, - -0.34312146362926105 - ], - "rotation_angle_deg": 0.537427381482163, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.042559367759759215, - 0.005651478599592696, - 0.06293302682193727 - ], - "translation_xyz_cm": [ - 4.255936775975922, - 0.5651478599592696, - 6.293302682193727 - ], - "translation_norm_m": 0.07618270708922573, - "rotation_rpy_deg_xyz": [ - 0.773816406459227, - 0.38939880915225783, - -0.35813628353299026 - ], - "rotation_angle_deg": 0.9383834935284217, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0012084044326331478, - -0.006652693350268857, - -0.001643756459884127 - ], - "translation_xyz_cm": [ - 0.12084044326331478, - -0.6652693350268857, - -0.1643756459884127 - ], - "translation_norm_m": 0.006958484417236967, - "rotation_rpy_deg_xyz": [ - 1.134519823402229, - 0.399543236410795, - 0.029673607002284125 - ], - "rotation_angle_deg": 1.2030837636924891, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005013587962429122, - 0.018902707193323653, - 0.001389097427827228 - ], - "translation_xyz_cm": [ - 0.5013587962429122, - 1.8902707193323653, - 0.1389097427827228 - ], - "translation_norm_m": 0.019605560312256833, - "rotation_rpy_deg_xyz": [ - 0.38975005300716165, - 0.24234669975734618, - -0.023953245473886168 - ], - "rotation_angle_deg": 0.4596194546773166, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0385316100979792, - -0.003960306322570495, - -0.03563416125456098 - ], - "translation_xyz_cm": [ - -3.8531610097979203, - -0.3960306322570495, - -3.563416125456098 - ], - "translation_norm_m": 0.05263233275494579, - "rotation_rpy_deg_xyz": [ - 0.8509414390006416, - 0.9431747440865678, - 0.5805574769578973 - ], - "rotation_angle_deg": 1.393759103123161, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0495012693336033, - -0.02701323282109691, - -0.04515125112735917 - ], - "translation_xyz_cm": [ - -4.9501269333603295, - -2.701323282109691, - -4.515125112735917 - ], - "translation_norm_m": 0.07224074952165553, - "rotation_rpy_deg_xyz": [ - 0.9701063489517499, - 1.5293054342359467, - 0.5000020635022965 - ], - "rotation_angle_deg": 1.875329306086429, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03304468665935635, - -0.021134286362485794, - -0.04355373803527227 - ], - "translation_xyz_cm": [ - -3.304468665935635, - -2.1134286362485795, - -4.355373803527227 - ], - "translation_norm_m": 0.058613458124493215, - "rotation_rpy_deg_xyz": [ - 0.6272635462651894, - 0.5065360658271248, - 0.6009343140391368 - ], - "rotation_angle_deg": 1.0039020927783573, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.0400093241247411, - -0.04209397634006268, - -0.05270500551737334 - ], - "translation_xyz_cm": [ - -4.00093241247411, - -4.209397634006268, - -5.270500551737333 - ], - "translation_norm_m": 0.0784249097393341, - "rotation_rpy_deg_xyz": [ - 0.8872990257972966, - 1.0507198301321041, - 0.5226803253903279 - ], - "rotation_angle_deg": 1.4683209256533662, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012424205121700102, - -0.013824259653033855, - -0.009820283420423872 - ], - "translation_xyz_cm": [ - -1.2424205121700103, - -1.3824259653033855, - -0.9820283420423872 - ], - "translation_norm_m": 0.021021631580779614, - "rotation_rpy_deg_xyz": [ - 0.45063891021737496, - 0.36063279991032504, - -0.08539419631068519 - ], - "rotation_angle_deg": 0.5836652248051724, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.010534817162542065, - -0.014171372308488306, - -0.1918618950426526 - ], - "translation_xyz_cm": [ - 1.0534817162542065, - -1.4171372308488306, - -19.18618950426526 - ], - "translation_norm_m": 0.19267277164952973, - "rotation_rpy_deg_xyz": [ - -0.680362715975756, - 0.2146567677942845, - 0.33542673759875685 - ], - "rotation_angle_deg": 0.7888821475294432, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0011431833360124877, - 0.008670018969148565, - -0.23735358140936716 - ], - "translation_xyz_cm": [ - 0.11431833360124877, - 0.8670018969148565, - -23.735358140936714 - ], - "translation_norm_m": 0.23751462840195384, - "rotation_rpy_deg_xyz": [ - -0.3875329666466126, - -0.13133136801870027, - 0.4359423008766097 - ], - "rotation_angle_deg": 0.5975678218772617, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0037952333453472598, - -0.0006829720830826558, - -0.022811466869101002 - ], - "translation_xyz_cm": [ - -0.379523334534726, - -0.06829720830826558, - -2.2811466869101 - ], - "translation_norm_m": 0.0231351089846579, - "rotation_rpy_deg_xyz": [ - 0.31909478008835235, - 0.1122590259269473, - -0.09140249959192183 - ], - "rotation_angle_deg": 0.35047834802405287, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0032791791905047024, - 0.025549309988807556, - -0.26935724398897837 - ], - "translation_xyz_cm": [ - 0.32791791905047024, - 2.5549309988807556, - -26.935724398897836 - ], - "translation_norm_m": 0.27058611410492894, - "rotation_rpy_deg_xyz": [ - -0.4499757208051441, - 0.197438229722607, - 0.07346445921233832 - ], - "rotation_angle_deg": 0.49696147802371693, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0018134896403780854, - 0.013958489200631807, - -0.16720106188015382 - ], - "translation_xyz_cm": [ - -0.18134896403780854, - 1.3958489200631807, - -16.720106188015382 - ], - "translation_norm_m": 0.1677925006050358, - "rotation_rpy_deg_xyz": [ - -0.44784997163606843, - 0.7520551832986743, - 0.27819711391889584 - ], - "rotation_angle_deg": 0.9193373705789156, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00722670703620365, - 0.024984699079277473, - 0.005937714053005486 - ], - "translation_xyz_cm": [ - 0.722670703620365, - 2.4984699079277473, - 0.5937714053005485 - ], - "translation_norm_m": 0.026678023368391122, - "rotation_rpy_deg_xyz": [ - 0.42292389365483346, - -0.749039610125762, - -0.24634407811618836 - ], - "rotation_angle_deg": 0.8940048352350047, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014240466879504643, - -0.029429641860023576, - -0.02062202589885176 - ], - "translation_xyz_cm": [ - -1.4240466879504643, - -2.9429641860023574, - -2.062202589885176 - ], - "translation_norm_m": 0.038654400385058796, - "rotation_rpy_deg_xyz": [ - 0.16366768065087955, - -0.312919199414986, - -0.4776403789399211 - ], - "rotation_angle_deg": 0.5936481544447167, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.005268333292513305, - 0.006642271805853306, - -0.00358888357065084 - ], - "translation_xyz_cm": [ - 0.5268333292513305, - 0.6642271805853306, - -0.35888835706508404 - ], - "translation_norm_m": 0.009206258507533087, - "rotation_rpy_deg_xyz": [ - 0.5760025971667578, - -0.5481253463676282, - -0.4789110286189978 - ], - "rotation_angle_deg": 0.9267852862265126, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01803235763300759, - 0.0094821067805122, - -0.21014383885820617 - ], - "translation_xyz_cm": [ - -1.803235763300759, - 0.9482106780512201, - -21.014383885820617 - ], - "translation_norm_m": 0.2111291293992031, - "rotation_rpy_deg_xyz": [ - -0.45891286684738847, - 1.1663309201090715, - -0.6358098287355123 - ], - "rotation_angle_deg": 1.4032889893521177, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.027260069081944907, - 0.023086463504124133, - -0.2346370826926915 - ], - "translation_xyz_cm": [ - -2.7260069081944907, - 2.3086463504124133, - -23.46370826926915 - ], - "translation_norm_m": 0.2373408029353921, - "rotation_rpy_deg_xyz": [ - 0.018167823373425557, - 1.1026145048121818, - -0.40438961035942034 - ], - "rotation_angle_deg": 1.1746301970193012, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011452794203644256, - 0.029696536825601694, - -0.037159170948348606 - ], - "translation_xyz_cm": [ - 1.1452794203644256, - 2.9696536825601694, - -3.7159170948348605 - ], - "translation_norm_m": 0.04892703526756899, - "rotation_rpy_deg_xyz": [ - 0.3959202349667615, - -0.10731572423022628, - -0.010805183939437071 - ], - "rotation_angle_deg": 0.4103391159352351, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012611561242430014, - 0.04330795250351738, - -0.13960169549897247 - ], - "translation_xyz_cm": [ - 1.2611561242430014, - 4.330795250351738, - -13.960169549897246 - ], - "translation_norm_m": 0.14670808980150452, - "rotation_rpy_deg_xyz": [ - -0.43352014445038856, - -0.2511016526862184, - 0.1651302439754783 - ], - "rotation_angle_deg": 0.5272054093515272, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005759942889726477, - 0.01778578703776712, - -0.08891615384695069 - ], - "translation_xyz_cm": [ - 0.5759942889726477, - 1.778578703776712, - -8.891615384695069 - ], - "translation_norm_m": 0.09086029703660625, - "rotation_rpy_deg_xyz": [ - -0.6949586121420581, - -0.13292552321710258, - 0.1630732401123115 - ], - "rotation_angle_deg": 0.7259242881267165, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.01013941826484488, - -0.026493847223189704, - -0.17247875234533577 - ], - "translation_xyz_cm": [ - -1.013941826484488, - -2.6493847223189704, - -17.247875234533577 - ], - "translation_norm_m": 0.17479602899962818, - "rotation_rpy_deg_xyz": [ - -0.7308025879395883, - 2.3018262204538793, - -0.37052952059304645 - ], - "rotation_angle_deg": 2.4410648786884552, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004040749791903053, - 0.019938761308488484, - -0.02364808368350669 - ], - "translation_xyz_cm": [ - 0.40407497919030533, - 1.9938761308488484, - -2.364808368350669 - ], - "translation_norm_m": 0.031194770768508257, - "rotation_rpy_deg_xyz": [ - 1.0707664334676017, - 0.10535044136821002, - 0.22113349946057315 - ], - "rotation_angle_deg": 1.0982269167001402, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.007608885388598496, - 0.03483911644294979, - 0.05245921154629435 - ], - "translation_xyz_cm": [ - 0.7608885388598496, - 3.483911644294979, - 5.245921154629435 - ], - "translation_norm_m": 0.06343207427982396, - "rotation_rpy_deg_xyz": [ - 1.2768047282496482, - 1.61650565311091, - 0.1588954980891925 - ], - "rotation_angle_deg": 2.0646389220928993, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.011328500962373145, - 0.0022021063590176304, - -0.033915689401122086 - ], - "translation_xyz_cm": [ - -1.1328500962373145, - 0.22021063590176304, - -3.3915689401122084 - ], - "translation_norm_m": 0.03582538477147594, - "rotation_rpy_deg_xyz": [ - 0.0736805946301165, - 2.5912128633384777, - 0.6967755997425028 - ], - "rotation_angle_deg": 2.6838225752955434, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01233359277913959, - -0.00027391774041030104, - 0.3847600110282744 - ], - "translation_xyz_cm": [ - 1.233359277913959, - -0.027391774041030104, - 38.47600110282744 - ], - "translation_norm_m": 0.3849577361584619, - "rotation_rpy_deg_xyz": [ - -1.1897373810542986, - 0.7865240707790055, - -0.06489140744167327 - ], - "rotation_angle_deg": 1.4273134868450823, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011175270164284212, - 0.03618249823522446, - 0.043948216569537776 - ], - "translation_xyz_cm": [ - 1.1175270164284212, - 3.618249823522446, - 4.394821656953778 - ], - "translation_norm_m": 0.058012977698354326, - "rotation_rpy_deg_xyz": [ - 1.4895067663479986, - -0.3593264005057602, - 0.058782878718561214 - ], - "rotation_angle_deg": 1.5335393469985126, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005309890243457183, - 0.014223913303248015, - -0.0011219171546463722 - ], - "translation_xyz_cm": [ - -0.5309890243457183, - 1.4223913303248015, - -0.11219171546463722 - ], - "translation_norm_m": 0.015224103985383423, - "rotation_rpy_deg_xyz": [ - 0.2921101405079319, - 2.19470253277069, - 0.493244174358528 - ], - "rotation_angle_deg": 2.2671077682811585, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03237939987201777, - 0.021105198832349625, - 0.14469945773305223 - ], - "translation_xyz_cm": [ - 3.2379399872017767, - 2.1105198832349625, - 14.469945773305223 - ], - "translation_norm_m": 0.14977245414983492, - "rotation_rpy_deg_xyz": [ - 0.10811461832641804, - -0.6024425954908642, - -0.2920066873686782 - ], - "rotation_angle_deg": 0.6779092050579141, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.008486608868385172, - 0.007934119859710709, - 0.38384225314940335 - ], - "translation_xyz_cm": [ - 0.8486608868385173, - 0.7934119859710709, - 38.38422531494034 - ], - "translation_norm_m": 0.38401803094495945, - "rotation_rpy_deg_xyz": [ - -0.4573866508524529, - 0.7303064650106631, - -0.241580174246308 - ], - "rotation_angle_deg": 0.8941469259755522, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.015319595185312007, - 0.009153567261168394, - 0.058067989034688426 - ], - "translation_xyz_cm": [ - -1.5319595185312007, - 0.9153567261168394, - 5.8067989034688425 - ], - "translation_norm_m": 0.060748408545238976, - "rotation_rpy_deg_xyz": [ - 1.0669693882760467, - 2.699696174501238, - 0.6007587126440506 - ], - "rotation_angle_deg": 2.9592572905732757, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03432191859373157, - 0.0004599857142828512, - 0.1828034481976781 - ], - "translation_xyz_cm": [ - 3.432191859373157, - 0.04599857142828512, - 18.28034481976781 - ], - "translation_norm_m": 0.1859981353556354, - "rotation_rpy_deg_xyz": [ - 0.44410084448866133, - -0.07583284174017302, - -0.21861818930184684 - ], - "rotation_angle_deg": 0.5006409070034052, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03851856094189676, - 0.007220727696369611, - 0.3149588984775229 - ], - "translation_xyz_cm": [ - 3.8518560941896762, - 0.7220727696369611, - 31.495889847752288 - ], - "translation_norm_m": 0.31738765914205663, - "rotation_rpy_deg_xyz": [ - 0.245234453614476, - 0.22660594000963757, - -0.23128194307475944 - ], - "rotation_angle_deg": 0.40645494055148196, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.027331169681078737, - 0.017990803972885994, - 0.06787335520989655 - ], - "translation_xyz_cm": [ - 2.7331169681078737, - 1.7990803972885994, - 6.7873355209896555 - ], - "translation_norm_m": 0.07534888327756105, - "rotation_rpy_deg_xyz": [ - 0.9768010429913935, - -2.3449367602167226, - -0.7900252549887521 - ], - "rotation_angle_deg": 2.654277681475962, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011699152000692159, - 0.023749586237988396, - 0.1996930086048151 - ], - "translation_xyz_cm": [ - -1.169915200069216, - 2.3749586237988396, - 19.96930086048151 - ], - "translation_norm_m": 0.2014403402738729, - "rotation_rpy_deg_xyz": [ - 0.8134489538358555, - -0.6653713050552823, - -0.7305917890822005 - ], - "rotation_angle_deg": 1.2772073393451708, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0031623013037365144, - -0.021691700057043795, - 0.16122094435572706 - ], - "translation_xyz_cm": [ - -0.31623013037365144, - -2.1691700057043795, - 16.122094435572706 - ], - "translation_norm_m": 0.16270440344333897, - "rotation_rpy_deg_xyz": [ - -0.9615359834506043, - 0.5220477108175814, - -0.024312305873250305 - ], - "rotation_angle_deg": 1.0942837538701056, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0044248708131103265, - -0.009663501350027026, - -0.06022582942117591 - ], - "translation_xyz_cm": [ - 0.44248708131103265, - -0.9663501350027026, - -6.022582942117591 - ], - "translation_norm_m": 0.06115646547604977, - "rotation_rpy_deg_xyz": [ - -0.3051191865789071, - 0.41512789286359764, - 0.0904310620320849 - ], - "rotation_angle_deg": 0.5232648617578812, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006239933109002394, - 0.026886202199366105, - 0.055097702610132956 - ], - "translation_xyz_cm": [ - 0.062399331090023935, - 2.6886202199366105, - 5.509770261013296 - ], - "translation_norm_m": 0.06131079896129147, - "rotation_rpy_deg_xyz": [ - -0.7141844010776622, - 0.025945501667523276, - -0.7153608827777813 - ], - "rotation_angle_deg": 1.0110567363387024, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013328334661552255, - -0.04541040828535481, - -0.002620544295995681 - ], - "translation_xyz_cm": [ - 1.3328334661552255, - -4.541040828535481, - -0.2620544295995681 - ], - "translation_norm_m": 0.04739849088209699, - "rotation_rpy_deg_xyz": [ - 0.2822141983504202, - 0.2686621165020366, - -0.6250257591830968 - ], - "rotation_angle_deg": 0.7370935080235231, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.014705880832284635, - -0.015318525252194792, - 0.004397574087667035 - ], - "translation_xyz_cm": [ - -1.4705880832284635, - -1.5318525252194792, - 0.43975740876670344 - ], - "translation_norm_m": 0.021685451455111714, - "rotation_rpy_deg_xyz": [ - 0.36627885383672737, - -0.11676100674895572, - -0.7052018477605642 - ], - "rotation_angle_deg": 0.8028540863803207, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.010970377201470427, - 0.019978682931102387, - -0.05695660423330406 - ], - "translation_xyz_cm": [ - 1.0970377201470427, - 1.9978682931102387, - -5.695660423330406 - ], - "translation_norm_m": 0.061347793060494794, - "rotation_rpy_deg_xyz": [ - 0.6038240632332217, - 0.17053405882170158, - 0.14493377448495626 - ], - "rotation_angle_deg": 0.6437625400530436, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.012568484690844206, - 0.005183416261077767, - 0.011195947053177627 - ], - "translation_xyz_cm": [ - 1.2568484690844206, - 0.5183416261077767, - 1.1195947053177626 - ], - "translation_norm_m": 0.017612036849187756, - "rotation_rpy_deg_xyz": [ - 0.9760464093483207, - 0.9514434581316742, - 0.02198475135969551 - ], - "rotation_angle_deg": 1.3630907276396187, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0041929945132821445, - -0.01829621110536478, - -0.008609875953255408 - ], - "translation_xyz_cm": [ - 0.41929945132821445, - -1.829621110536478, - -0.8609875953255408 - ], - "translation_norm_m": 0.02065096868747162, - "rotation_rpy_deg_xyz": [ - -1.292917686151329, - -1.0940728948699525, - 0.1511395381830308 - ], - "rotation_angle_deg": 1.6993207284585017, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.011979077828340179, - -0.0007078874758068288, - 0.02340629706959646 - ], - "translation_xyz_cm": [ - 1.1979077828340179, - -0.07078874758068288, - 2.3406297069596462 - ], - "translation_norm_m": 0.026303120590645424, - "rotation_rpy_deg_xyz": [ - -0.1852616583004333, - -0.6325232577097998, - -0.1280088966804985 - ], - "rotation_angle_deg": 0.6716063638167964, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.003817459203782736, - -0.02899843590518736, - 0.025223252748165392 - ], - "translation_xyz_cm": [ - 0.3817459203782736, - -2.899843590518736, - 2.5223252748165392 - ], - "translation_norm_m": 0.03862246443350861, - "rotation_rpy_deg_xyz": [ - 1.3806702282737195, - 0.10057334252830462, - -0.1908045082673216 - ], - "rotation_angle_deg": 1.3975806948785885, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0013340231363224153, - 0.01802472545731648, - -0.07459483930414268 - ], - "translation_xyz_cm": [ - 0.13340231363224153, - 1.8024725457316482, - -7.459483930414268 - ], - "translation_norm_m": 0.07675324355589636, - "rotation_rpy_deg_xyz": [ - 0.29806895269189154, - 1.6463209806210906, - 0.09658458189116394 - ], - "rotation_angle_deg": 1.6756230084105757, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009189178037268375, - 0.022989790330300686, - 0.04243567032035929 - ], - "translation_xyz_cm": [ - -0.9189178037268375, - 2.2989790330300686, - 4.243567032035929 - ], - "translation_norm_m": 0.04913000679798472, - "rotation_rpy_deg_xyz": [ - 0.5159776510240327, - 0.9487596628444609, - -0.2756716403640239 - ], - "rotation_angle_deg": 1.115670072207702, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0005181014451935972, - -0.037395534536625696, - -0.0607541067098248 - ], - "translation_xyz_cm": [ - 0.051810144519359724, - -3.7395534536625696, - -6.07541067098248 - ], - "translation_norm_m": 0.07134252528819159, - "rotation_rpy_deg_xyz": [ - 0.317364267113907, - 0.5126210897804444, - -0.09093646794300284 - ], - "rotation_angle_deg": 0.6099404568548947, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.003140484022062351, - 0.03250549751540799, - -0.051267942844547984 - ], - "translation_xyz_cm": [ - 0.3140484022062351, - 3.250549751540799, - -5.126794284454799 - ], - "translation_norm_m": 0.060785458558185304, - "rotation_rpy_deg_xyz": [ - 0.04228980109566747, - 1.4303747493098449, - 0.21950344947148706 - ], - "rotation_angle_deg": 1.4476559590843263, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017917315292633518, - 0.012983899824875578, - -0.0768225076282979 - ], - "translation_xyz_cm": [ - -1.7917315292633518, - 1.2983899824875578, - -7.68225076282979 - ], - "translation_norm_m": 0.07994566605049915, - "rotation_rpy_deg_xyz": [ - 0.4654275567058775, - 0.1482087035655817, - 0.361012897676504 - ], - "rotation_angle_deg": 0.6070283323815563, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.026202717324959046, - 0.013680751945012504, - -0.07151223308415863 - ], - "translation_xyz_cm": [ - -2.6202717324959046, - 1.3680751945012504, - -7.151223308415863 - ], - "translation_norm_m": 0.07738051983332565, - "rotation_rpy_deg_xyz": [ - 0.12932770394143708, - 0.43630272092390676, - 0.07583192627713882 - ], - "rotation_angle_deg": 0.461260673032457, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03063988019392594, - 0.020238332863780295, - -0.05054251687036663 - ], - "translation_xyz_cm": [ - -3.063988019392594, - 2.0238332863780295, - -5.054251687036663 - ], - "translation_norm_m": 0.0624735014785837, - "rotation_rpy_deg_xyz": [ - 0.5473360023988134, - 0.6455825883070815, - 0.32309847218608473 - ], - "rotation_angle_deg": 0.9048472479466932, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0061291733287154315, - -0.01185974736662887, - -0.06289542316473563 - ], - "translation_xyz_cm": [ - -0.6129173328715432, - -1.185974736662887, - -6.289542316473564 - ], - "translation_norm_m": 0.06429661443936889, - "rotation_rpy_deg_xyz": [ - 1.0985801392160905, - 0.8156481141656465, - 0.49938922778829087 - ], - "rotation_angle_deg": 1.453859530373065, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.020028356175772144, - -0.01885263649073754, - -0.022664253410455047 - ], - "translation_xyz_cm": [ - 2.0028356175772144, - -1.885263649073754, - -2.2664253410455046 - ], - "translation_norm_m": 0.03564022076823883, - "rotation_rpy_deg_xyz": [ - -0.12825799086488499, - 0.015584578498526942, - -0.23189705919404002 - ], - "rotation_angle_deg": 0.2654451438900604, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008563224527435243, - -0.0009111948279650894, - -0.04256244290441862 - ], - "translation_xyz_cm": [ - -0.8563224527435243, - -0.09111948279650894, - -4.256244290441862 - ], - "translation_norm_m": 0.04342488498906674, - "rotation_rpy_deg_xyz": [ - 0.8008393054101358, - 0.3829544609462284, - 0.26675426286476717 - ], - "rotation_angle_deg": 0.926133841535343, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0016288767772019153, - -0.001566337997829681, - 0.056399901191088446 - ], - "translation_xyz_cm": [ - 0.16288767772019153, - -0.1566337997829681, - 5.639990119108845 - ], - "translation_norm_m": 0.05644515487305613, - "rotation_rpy_deg_xyz": [ - 1.3259817177388369, - -0.24200444352014017, - -0.2755118520893106 - ], - "rotation_angle_deg": 1.3751913639951892, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011249311803285256, - 0.007454959145737128, - 0.008440848967616904 - ], - "translation_xyz_cm": [ - -1.1249311803285256, - 0.7454959145737128, - 0.8440848967616904 - ], - "translation_norm_m": 0.015917643142320474, - "rotation_rpy_deg_xyz": [ - 1.2798324417234241, - 0.7511290162919234, - 0.4299909022015112 - ], - "rotation_angle_deg": 1.5426632139601855, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.004457525517122196, - -0.006747037647768295, - -0.03303098126313028 - ], - "translation_xyz_cm": [ - -0.4457525517122196, - -0.6747037647768295, - -3.3030981263130283 - ], - "translation_norm_m": 0.034006437242990656, - "rotation_rpy_deg_xyz": [ - -0.2368252930177511, - 0.8465036337187393, - -0.29199164949942313 - ], - "rotation_angle_deg": 0.9256832050937281, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.007958744132824158, - 0.014048532409291603, - 0.13790486483963457 - ], - "translation_xyz_cm": [ - 0.7958744132824158, - 1.4048532409291603, - 13.790486483963457 - ], - "translation_norm_m": 0.13884687471262924, - "rotation_rpy_deg_xyz": [ - 1.8345132670598652, - -0.18259675286061222, - -0.4919660503492367 - ], - "rotation_angle_deg": 1.9073308881344613, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.003657989460382982, - 0.0020782519030515534, - 0.08070282632715196 - ], - "translation_xyz_cm": [ - 0.3657989460382982, - 0.20782519030515534, - 8.070282632715196 - ], - "translation_norm_m": 0.0808124136197853, - "rotation_rpy_deg_xyz": [ - 1.3592446643525997, - 0.364109254431936, - 0.1904934648769708 - ], - "rotation_angle_deg": 1.4194209619041651, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.010415206685276956, - 0.009432653787927903, - 0.024726810769036545 - ], - "translation_xyz_cm": [ - 1.0415206685276956, - 0.9432653787927903, - 2.4726810769036547 - ], - "translation_norm_m": 0.028440581192860494, - "rotation_rpy_deg_xyz": [ - 0.9643782837374131, - 1.1582854880235, - -0.4986500290607745 - ], - "rotation_angle_deg": 1.5905905041322577, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006927703825956755, - 0.04263708098707397, - 0.08624202281184644 - ], - "translation_xyz_cm": [ - -0.6927703825956755, - 4.263708098707397, - 8.624202281184644 - ], - "translation_norm_m": 0.09645517225155695, - "rotation_rpy_deg_xyz": [ - -1.2549247776387382, - -0.2792749388709897, - 0.6235469239446558 - ], - "rotation_angle_deg": 1.4275180868008872, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024442111996924254, - 0.026156064527284695, - 0.06446967828798487 - ], - "translation_xyz_cm": [ - 2.4442111996924254, - 2.6156064527284695, - 6.4469678287984875 - ], - "translation_norm_m": 0.07374209089103684, - "rotation_rpy_deg_xyz": [ - -0.510125802688496, - 0.04383902350441292, - 0.5051263124119654 - ], - "rotation_angle_deg": 0.719373500974471, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0044829420071716974, - -0.030375636666296557, - 0.009457402180294339 - ], - "translation_xyz_cm": [ - -0.44829420071716974, - -3.037563666629656, - 0.9457402180294339 - ], - "translation_norm_m": 0.03212815786692976, - "rotation_rpy_deg_xyz": [ - 0.12662788496071836, - -0.4903130939946766, - -0.12087698535903475 - ], - "rotation_angle_deg": 0.5205013144349281, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.023364690266714616, - 0.032424594484683045, - -0.04896326387942729 - ], - "translation_xyz_cm": [ - -2.3364690266714616, - 3.2424594484683045, - -4.896326387942729 - ], - "translation_norm_m": 0.06320335662353761, - "rotation_rpy_deg_xyz": [ - -1.027448825281515, - -0.49577027260555667, - -0.058051459275652736 - ], - "rotation_angle_deg": 1.142505414712634, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.009751850611102064, - 0.04081817815004052, - -0.0030213617663471942 - ], - "translation_xyz_cm": [ - 0.9751850611102064, - 4.081817815004052, - -0.3021361766347194 - ], - "translation_norm_m": 0.0420755378427043, - "rotation_rpy_deg_xyz": [ - -0.5490229977344162, - -0.06133887265113584, - -0.07300507227226792 - ], - "rotation_angle_deg": 0.5572802613238103, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.00010814298275940715, - -0.006806945365397388, - 0.03248653974388574 - ], - "translation_xyz_cm": [ - 0.010814298275940715, - -0.6806945365397388, - 3.248653974388574 - ], - "translation_norm_m": 0.03319218981391997, - "rotation_rpy_deg_xyz": [ - 0.33253490197904234, - -1.045738208388483, - 0.23454245874722918 - ], - "rotation_angle_deg": 1.1227541050725756, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01667507365454446, - 0.0050693288360967315, - 0.039280406310347495 - ], - "translation_xyz_cm": [ - -1.667507365454446, - 0.5069328836096731, - 3.9280406310347495 - ], - "translation_norm_m": 0.04297332307535632, - "rotation_rpy_deg_xyz": [ - -0.6725044917852302, - -0.8733602195364386, - 0.17338243219424504 - ], - "rotation_angle_deg": 1.1150313026999508, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.004462990554140678, - 0.02293435134317867, - -0.036022514330451866 - ], - "translation_xyz_cm": [ - 0.4462990554140678, - 2.293435134317867, - -3.6022514330451867 - ], - "translation_norm_m": 0.04293628180113318, - "rotation_rpy_deg_xyz": [ - 0.08679985795758756, - -0.06047506422640799, - 0.10688132699859541 - ], - "rotation_angle_deg": 0.15041560730817227, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015916683030818612, - 0.02135330688701731, - -0.07670688275559603 - ], - "translation_xyz_cm": [ - 1.5916683030818612, - 2.135330688701731, - -7.670688275559604 - ], - "translation_norm_m": 0.08119883235487717, - "rotation_rpy_deg_xyz": [ - 0.9774984190679189, - -0.005849230156486498, - 0.10908346343039184 - ], - "rotation_angle_deg": 0.9835889237253328, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.008399990332810914, - 0.002704904672676811, - -0.007835193327143605 - ], - "translation_xyz_cm": [ - -0.8399990332810914, - 0.2704904672676811, - -0.7835193327143605 - ], - "translation_norm_m": 0.011801127122156651, - "rotation_rpy_deg_xyz": [ - 0.16080697305435693, - -0.026871072388182548, - -0.050783059749707773 - ], - "rotation_angle_deg": 0.17075135188143103, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.018227936315988735, - 0.02873703746130829, - -0.05145425690187779 - ], - "translation_xyz_cm": [ - 1.8227936315988735, - 2.873703746130829, - -5.145425690187779 - ], - "translation_norm_m": 0.061689671240142095, - "rotation_rpy_deg_xyz": [ - 0.6571800764521991, - 0.4753577418219716, - -0.1375011149178113 - ], - "rotation_angle_deg": 0.8231063727904296, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.023267135187196253, - 0.024258596948667943, - 0.021895891107411893 - ], - "translation_xyz_cm": [ - 2.3267135187196253, - 2.4258596948667943, - 2.1895891107411893 - ], - "translation_norm_m": 0.040115697091348504, - "rotation_rpy_deg_xyz": [ - 0.9643023690540663, - 0.3961876297678032, - -0.08288069669962593 - ], - "rotation_angle_deg": 1.0460696226705286, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.000582689025208305, - -0.001053362440468053, - 0.010516974904899494 - ], - "translation_xyz_cm": [ - -0.0582689025208305, - -0.1053362440468053, - 1.0516974904899494 - ], - "translation_norm_m": 0.01058564405604934, - "rotation_rpy_deg_xyz": [ - 0.6424961469343806, - -0.03128435221662172, - 0.007452849530443232 - ], - "rotation_angle_deg": 0.6433025401774949, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.08194010685064068, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0682090297399528, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015144034812935, - -6.733076264476427e-05, - 0.7136929353101595 - ], - "rotation_rpy_deg_xyz": [ - -0.789527196617764, - 1.5026289218840854, - -0.8356133538033519 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11907438084482405, - "median": 0.06040632745373972, - "p90": 0.19318837646570378, - "p95": 0.2441172898549916, - "max": 0.38382501857987256 - }, - "rotation_deg": { - "rms": 1.246448116042569, - "median": 0.9747369258829759, - "p90": 1.7893824846190438, - "p95": 2.3934613719224314, - "max": 3.0644491968168026 - }, - "normalized_pair_score": { - "rms": 3.4476100262900324, - "median": 2.5756229613307933, - "p90": 5.507574964183342, - "p95": 6.06974806590713, - "max": 8.274645388871255 - }, - "normalized_global_rms": 3.4476100262900324 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018715599667938454, - 0.02030334963778846, - 0.08450445341369167 - ], - "translation_xyz_cm": [ - -1.8715599667938454, - 2.030334963778846, - 8.450445341369168 - ], - "translation_norm_m": 0.08890164410286015, - "rotation_rpy_deg_xyz": [ - 0.43908773114093497, - 0.10686430911077906, - 0.0961240954353524 - ], - "rotation_angle_deg": 0.4619296835950138, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.669238092496052, - "median": 0.7629681084794777, - "p90": 2.2411288080915024, - "p95": 3.711431307771875, - "max": 5.607648580302171 - }, - "height_residual_m": { - "rms": 0.034713965171217276, - "median": -0.0059241016060887774, - "p90": 0.05340926734199069, - "p95": 0.08720196104337445, - "max": 0.12336745254185391 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018715599667938454, - 0.02030334963778846, - 0.08450445341369167 - ], - "translation_xyz_cm": [ - -1.8715599667938454, - 2.030334963778846, - 8.450445341369168 - ], - "translation_norm_m": 0.08890164410286015, - "rotation_rpy_deg_xyz": [ - 0.43908773114093497, - 0.10686430911077906, - 0.0961240954353524 - ], - "rotation_angle_deg": 0.4619296835950138, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019071421279922562, - -0.024831745317817955, - 0.1658229663495363 - ], - "translation_xyz_cm": [ - 1.9071421279922562, - -2.4831745317817955, - 16.58229663495363 - ], - "translation_norm_m": 0.16875304694767648, - "rotation_rpy_deg_xyz": [ - -0.2614991129352451, - -0.2941422032069858, - -0.3526538569108817 - ], - "rotation_angle_deg": 0.5289035384231568, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.02985396831594178, - 0.0015923563123458884, - 0.14504798738119373 - ], - "translation_xyz_cm": [ - 2.985396831594178, - 0.15923563123458884, - 14.504798738119373 - ], - "translation_norm_m": 0.1480969738589201, - "rotation_rpy_deg_xyz": [ - 0.10491877406744535, - -0.1966281605675299, - -0.3861202715295272 - ], - "rotation_angle_deg": 0.44566828590543006, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.007762230153940355, - -0.0036752517698213083, - 0.09573938325938014 - ], - "translation_xyz_cm": [ - -0.7762230153940355, - -0.36752517698213083, - 9.573938325938014 - ], - "translation_norm_m": 0.09612382222644288, - "rotation_rpy_deg_xyz": [ - 0.8429555219697454, - 0.2883385070666861, - 0.2135656280908825 - ], - "rotation_angle_deg": 0.915650037376567, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.016849494248640573, - -0.006966546379263194, - -0.03323601556493608 - ], - "translation_xyz_cm": [ - -1.6849494248640573, - -0.6966546379263194, - -3.3236015564936077 - ], - "translation_norm_m": 0.037908718726990365, - "rotation_rpy_deg_xyz": [ - 0.8656348914247324, - 0.14985277187490095, - 0.07089034629746543 - ], - "rotation_angle_deg": 0.881274099340132, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03077317746597974, - -0.01856083572278311, - 0.07154319648717015 - ], - "translation_xyz_cm": [ - 3.077317746597974, - -1.856083572278311, - 7.154319648717015 - ], - "translation_norm_m": 0.08006198871925842, - "rotation_rpy_deg_xyz": [ - 0.4304889270041019, - 0.07062518825078377, - -0.34248580301712134 - ], - "rotation_angle_deg": 0.554784917676273, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.042660066350481474, - 0.005051032116579424, - 0.06145791620852596 - ], - "translation_xyz_cm": [ - 4.266006635048147, - 0.5051032116579424, - 6.145791620852596 - ], - "translation_norm_m": 0.07498312911024983, - "rotation_rpy_deg_xyz": [ - 0.8214114189544236, - 0.4022101425589988, - -0.35657429812002833 - ], - "rotation_angle_deg": 0.982693015598886, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.002212711365206982, - -0.007773707539271646, - -0.0038956068889624065 - ], - "translation_xyz_cm": [ - 0.2212711365206982, - -0.7773707539271646, - -0.3895606888962406 - ], - "translation_norm_m": 0.008972311492874974, - "rotation_rpy_deg_xyz": [ - 1.230471210713483, - 0.4767552190857044, - 0.0347649787818421 - ], - "rotation_angle_deg": 1.3199237879238872, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005058434441481405, - 0.018571640454333488, - 0.0012695721708060811 - ], - "translation_xyz_cm": [ - 0.5058434441481405, - 1.8571640454333487, - 0.12695721708060811 - ], - "translation_norm_m": 0.019290033739231424, - "rotation_rpy_deg_xyz": [ - 0.4163039003088602, - 0.24632630016723878, - -0.02319701140433222 - ], - "rotation_angle_deg": 0.4843190397003249, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03810377655710681, - -0.0047683148960116495, - -0.036156347489690294 - ], - "translation_xyz_cm": [ - -3.810377655710681, - -0.47683148960116495, - -3.6156347489690295 - ], - "translation_norm_m": 0.05274387242757857, - "rotation_rpy_deg_xyz": [ - 0.9207792748311079, - 0.972957238397551, - 0.5831992174292693 - ], - "rotation_angle_deg": 1.4578912158476167, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.048760178896770284, - -0.028004699259437382, - -0.04601281623925102 - ], - "translation_xyz_cm": [ - -4.876017889677028, - -2.8004699259437382, - -4.601281623925102 - ], - "translation_norm_m": 0.07265670984103022, - "rotation_rpy_deg_xyz": [ - 1.0584557176352027, - 1.5850495116769183, - 0.5039971440628994 - ], - "rotation_angle_deg": 1.9677070233529221, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03280588813135871, - -0.02169425164446842, - -0.043919264139142 - ], - "translation_xyz_cm": [ - -3.2805888131358705, - -2.1694251644468423, - -4.3919264139142005 - ], - "translation_norm_m": 0.05895564954289341, - "rotation_rpy_deg_xyz": [ - 0.6758392998714334, - 0.5199082917327633, - 0.6025024601341834 - ], - "rotation_angle_deg": 1.0422897103392073, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03951732519772003, - -0.0429157271471684, - -0.053329576509569404 - ], - "translation_xyz_cm": [ - -3.9517325197720026, - -4.291572714716841, - -5.33295765095694 - ], - "translation_norm_m": 0.07904063738383302, - "rotation_rpy_deg_xyz": [ - 0.9606121024354892, - 1.0842031184203456, - 0.5255406441745397 - ], - "rotation_angle_deg": 1.5378132781527352, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012331570332578964, - -0.014206777526816733, - -0.009882519258301175 - ], - "translation_xyz_cm": [ - -1.2331570332578965, - -1.4206777526816734, - -0.9882519258301175 - ], - "translation_norm_m": 0.02125004332829701, - "rotation_rpy_deg_xyz": [ - 0.4820285188843344, - 0.3661537767136861, - -0.08447717236033091 - ], - "rotation_angle_deg": 0.61140481197507, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.0115834503031913, - -0.014988280229611087, - -0.1921354464659431 - ], - "translation_xyz_cm": [ - 1.15834503031913, - -1.4988280229611086, - -19.21354464659431 - ], - "translation_norm_m": 0.193066969349589, - "rotation_rpy_deg_xyz": [ - -0.5848007316446472, - 0.2904865721778513, - 0.33805655280880775 - ], - "rotation_angle_deg": 0.7359734469457951, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0019335908174579197, - 0.007944327792826026, - -0.2378748479828195 - ], - "translation_xyz_cm": [ - 0.19335908174579197, - 0.7944327792826026, - -23.787484798281948 - ], - "translation_norm_m": 0.23801532391923574, - "rotation_rpy_deg_xyz": [ - -0.30451525929237233, - -0.08482465207041116, - 0.438407109931438 - ], - "rotation_angle_deg": 0.5403030716069073, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0026016244598716654, - -0.0016654489186634924, - -0.02322063399635084 - ], - "translation_xyz_cm": [ - -0.26016244598716654, - -0.16654489186634924, - -2.322063399635084 - ], - "translation_norm_m": 0.023425200385980997, - "rotation_rpy_deg_xyz": [ - 0.41743175927448545, - 0.20609394946909027, - -0.08701337899425825 - ], - "rotation_angle_deg": 0.47373593875775505, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004916562619849116, - 0.024869962715908356, - -0.2713866359188753 - ], - "translation_xyz_cm": [ - 0.4916562619849116, - 2.4869962715908356, - -27.13866359188753 - ], - "translation_norm_m": 0.2725681452203279, - "rotation_rpy_deg_xyz": [ - -0.36151971211363887, - 0.34114741034773294, - 0.07666806847247014 - ], - "rotation_angle_deg": 0.5031109805300356, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0014525187031515507, - 0.01356363395918414, - -0.17009826834799804 - ], - "translation_xyz_cm": [ - -0.14525187031515507, - 1.356363395918414, - -17.009826834799803 - ], - "translation_norm_m": 0.1706443754471541, - "rotation_rpy_deg_xyz": [ - -0.4068547252076535, - 0.7614960604475388, - 0.27929600560751533 - ], - "rotation_angle_deg": 0.9082508544171838, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.007868602861403895, - 0.024119571797947215, - 0.00417776805396694 - ], - "translation_xyz_cm": [ - 0.7868602861403895, - 2.4119571797947215, - 0.41777680539669404 - ], - "translation_norm_m": 0.025712300570341247, - "rotation_rpy_deg_xyz": [ - 0.5022555106428017, - -0.7079502455761153, - -0.24343311041864663 - ], - "rotation_angle_deg": 0.9006657331652769, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014235359652051693, - -0.030115155547563374, - -0.01895921638921054 - ], - "translation_xyz_cm": [ - -1.4235359652051693, - -3.0115155547563375, - -1.895921638921054 - ], - "translation_norm_m": 0.038327795973289516, - "rotation_rpy_deg_xyz": [ - 0.21168233132041078, - -0.2998439952663938, - -0.4761995398746635 - ], - "rotation_angle_deg": 0.6007939962785852, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.005575061581351237, - 0.005792380928994867, - -0.0029767309896256283 - ], - "translation_xyz_cm": [ - 0.5575061581351237, - 0.5792380928994867, - -0.29767309896256283 - ], - "translation_norm_m": 0.008572859257391293, - "rotation_rpy_deg_xyz": [ - 0.642693080213692, - -0.521327786113756, - -0.4765646341395547 - ], - "rotation_angle_deg": 0.9534973822674689, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.016684410657332616, - 0.008637466576415065, - -0.2144975151185115 - ], - "translation_xyz_cm": [ - -1.6684410657332616, - 0.8637466576415065, - -21.44975151185115 - ], - "translation_norm_m": 0.21531873903554533, - "rotation_rpy_deg_xyz": [ - -0.36088416245017657, - 1.2767756201954588, - -0.6325945187219778 - ], - "rotation_angle_deg": 1.4681480310999107, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.025620343409644426, - 0.02242394764885569, - -0.24021900217697773 - ], - "translation_xyz_cm": [ - -2.5620343409644426, - 2.242394764885569, - -24.021900217697773 - ], - "translation_norm_m": 0.24261987641471083, - "rotation_rpy_deg_xyz": [ - 0.10648583369566302, - 1.2467275808379423, - -0.40001014721603206 - ], - "rotation_angle_deg": 1.3140004031925836, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011625960590931239, - 0.029454888923292843, - -0.03796548717912122 - ], - "translation_xyz_cm": [ - 1.162596059093124, - 2.9454888923292843, - -3.796548717912122 - ], - "translation_norm_m": 0.049438159936363156, - "rotation_rpy_deg_xyz": [ - 0.41892039739038267, - -0.10429981541222079, - -0.010158796448439384 - ], - "rotation_angle_deg": 0.43181958735049714, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013026331117703238, - 0.04282007169357027, - -0.14153194667251126 - ], - "translation_xyz_cm": [ - 1.3026331117703238, - 4.282007169357027, - -14.153194667251126 - ], - "translation_norm_m": 0.14844034414922755, - "rotation_rpy_deg_xyz": [ - -0.384605881977728, - -0.2374946785385558, - 0.16646101168309774 - ], - "rotation_angle_deg": 0.48142387234968315, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005934441246564837, - 0.017471493676525895, - -0.08983428695196699 - ], - "translation_xyz_cm": [ - 0.5934441246564837, - 1.7471493676525895, - -8.983428695196698 - ], - "translation_norm_m": 0.09170970393783943, - "rotation_rpy_deg_xyz": [ - -0.6673000960245402, - -0.12860146232112282, - 0.16378279347392696 - ], - "rotation_angle_deg": 0.698861036046584, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.00973652536316072, - -0.027071823979757603, - -0.1768640664883896 - ], - "translation_xyz_cm": [ - -0.973652536316072, - -2.7071823979757603, - -17.68640664883896 - ], - "translation_norm_m": 0.17918867596627847, - "rotation_rpy_deg_xyz": [ - -0.6709886365653246, - 2.322749916526881, - -0.3689809385095929 - ], - "rotation_angle_deg": 2.4436491379635874, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004191830851316913, - 0.019561658061449383, - -0.024763805977951713 - ], - "translation_xyz_cm": [ - 0.41918308513169134, - 1.9561658061449383, - -2.4763805977951714 - ], - "translation_norm_m": 0.03183513779635259, - "rotation_rpy_deg_xyz": [ - 1.1051970229262853, - 0.1119730886542171, - 0.2222240409157647 - ], - "rotation_angle_deg": 1.1326517744850761, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.007952187523372567, - 0.03420142331912923, - 0.04842885524446608 - ], - "translation_xyz_cm": [ - 0.7952187523372567, - 3.420142331912923, - 4.842885524446608 - ], - "translation_norm_m": 0.05981913292376118, - "rotation_rpy_deg_xyz": [ - 1.3422950677616174, - 1.6420870682497624, - 0.16149382611029145 - ], - "rotation_angle_deg": 2.1255463480343315, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.009590071260934696, - 0.001185538987347634, - -0.039394851341081526 - ], - "translation_xyz_cm": [ - -0.9590071260934696, - 0.11855389873476341, - -3.9394851341081525 - ], - "translation_norm_m": 0.04056265871052143, - "rotation_rpy_deg_xyz": [ - 0.16109527583854424, - 2.737344111608719, - 0.7013035455766343 - ], - "rotation_angle_deg": 2.829370033323507, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015392506036528308, - -0.00034141615134930525, - 0.3835161001584765 - ], - "translation_xyz_cm": [ - 1.5392506036528308, - -0.034141615134930525, - 38.35161001584765 - ], - "translation_norm_m": 0.38382501857987256, - "rotation_rpy_deg_xyz": [ - -1.187115834013387, - 0.9864249039666126, - -0.06621886301049175 - ], - "rotation_angle_deg": 1.5444334200955796, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011359031599979197, - 0.035855718119232605, - 0.041026779030696806 - ], - "translation_xyz_cm": [ - 1.1359031599979197, - 3.5855718119232605, - 4.10267790306968 - ], - "translation_norm_m": 0.05565839306312045, - "rotation_rpy_deg_xyz": [ - 1.525141717148522, - -0.3522374144954907, - 0.059971713057031785 - ], - "rotation_angle_deg": 1.5666141235212636, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.003935038840920946, - 0.013006794661833077, - -0.004852434807673835 - ], - "translation_xyz_cm": [ - -0.3935038840920946, - 1.3006794661833077, - -0.4852434807673835 - ], - "translation_norm_m": 0.014429392281637175, - "rotation_rpy_deg_xyz": [ - 0.3899921344407746, - 2.307346929459358, - 0.4979473461697167 - ], - "rotation_angle_deg": 2.390819910551844, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03485365632511561, - 0.019929194822270624, - 0.14127246940166477 - ], - "translation_xyz_cm": [ - 3.485365632511561, - 1.9929194822270624, - 14.127246940166478 - ], - "translation_norm_m": 0.1468668130529753, - "rotation_rpy_deg_xyz": [ - 0.18092454539080838, - -0.43561296231716207, - -0.28744104005274157 - ], - "rotation_angle_deg": 0.5520132991059329, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.011453585386029572, - 0.007242966037118936, - 0.3820913090156576 - ], - "translation_xyz_cm": [ - 1.1453585386029572, - 0.7242966037118936, - 38.20913090156576 - ], - "translation_norm_m": 0.38233154931356195, - "rotation_rpy_deg_xyz": [ - -0.4204734738032539, - 0.9226394156264088, - -0.23947017570814846 - ], - "rotation_angle_deg": 1.0410478600811488, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.014375435020591798, - 0.007886427232864257, - 0.057997587308745845 - ], - "translation_xyz_cm": [ - -1.4375435020591798, - 0.7886427232864257, - 5.799758730874585 - ], - "translation_norm_m": 0.06027079724183278, - "rotation_rpy_deg_xyz": [ - 1.1628981584269709, - 2.775984048742805, - 0.6057280354468255 - ], - "rotation_angle_deg": 3.0644491968168026, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.036194309520529155, - -0.001057739646858069, - 0.18153923162197713 - ], - "translation_xyz_cm": [ - 3.6194309520529155, - -0.10577396468580691, - 18.153923162197714 - ], - "translation_norm_m": 0.18511520594680023, - "rotation_rpy_deg_xyz": [ - 0.5359484513153905, - 0.05996443895446484, - -0.21325700551943688 - ], - "rotation_angle_deg": 0.5800295536328113, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.041113437442894085, - 0.005968617746470173, - 0.31431763501787036 - ], - "translation_xyz_cm": [ - 4.1113437442894085, - 0.5968617746470173, - 31.431763501787035 - ], - "translation_norm_m": 0.31705128105623764, - "rotation_rpy_deg_xyz": [ - 0.31261894052332195, - 0.39906897300961824, - -0.22635920224885922 - ], - "rotation_angle_deg": 0.5556233288263414, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.027549166999644825, - 0.01721428718165874, - 0.0637934126970153 - ], - "translation_xyz_cm": [ - 2.7549166999644825, - 1.7214287181658738, - 6.37934126970153 - ], - "translation_norm_m": 0.07158832159702204, - "rotation_rpy_deg_xyz": [ - 1.0333247286995204, - -2.326404310406196, - -0.7880070044768772 - ], - "rotation_angle_deg": 2.6584885154876416, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011067358250941073, - 0.02242071847355387, - 0.1926653774459994 - ], - "translation_xyz_cm": [ - -1.1067358250941073, - 2.242071847355387, - 19.26653774459994 - ], - "translation_norm_m": 0.19428104051073652, - "rotation_rpy_deg_xyz": [ - 0.8993604054038085, - -0.6139895121244008, - -0.7269352335508233 - ], - "rotation_angle_deg": 1.30661298172542, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0031422315916247445, - -0.02231411581410736, - 0.1580099056254013 - ], - "translation_xyz_cm": [ - -0.31422315916247445, - -2.231411581410736, - 15.800990562540129 - ], - "translation_norm_m": 0.15960865784690073, - "rotation_rpy_deg_xyz": [ - -0.9186928188658955, - 0.5323904761603733, - -0.023253373136437824 - ], - "rotation_angle_deg": 1.0619662161447185, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.004901826705696, - -0.010477541186948436, - -0.06433241884702087 - ], - "translation_xyz_cm": [ - 0.49018267056959997, - -1.0477541186948436, - -6.433241884702087 - ], - "translation_norm_m": 0.0653641100993917, - "rotation_rpy_deg_xyz": [ - -0.23484544963836307, - 0.44543291499998655, - 0.09248727141467615 - ], - "rotation_angle_deg": 0.5121379583189214, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.000977312659879992, - 0.026186951631097743, - 0.048906251946090454 - ], - "translation_xyz_cm": [ - 0.0977312659879992, - 2.6186951631097743, - 4.890625194609045 - ], - "translation_norm_m": 0.05548452987256079, - "rotation_rpy_deg_xyz": [ - -0.658475556843526, - 0.043895934596583176, - -0.7139160970827229 - ], - "rotation_angle_deg": 0.972022271109971, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013799125323654682, - -0.04636380901075943, - -0.001930753106745679 - ], - "translation_xyz_cm": [ - 1.3799125323654682, - -4.636380901075943, - -0.1930753106745679 - ], - "translation_norm_m": 0.0484122551968333, - "rotation_rpy_deg_xyz": [ - 0.3592443419799681, - 0.30665660368970005, - -0.6223364671941953 - ], - "rotation_angle_deg": 0.782043180025071, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.013124677744138946, - -0.013915325370447373, - 0.00040431092827344917 - ], - "translation_xyz_cm": [ - -1.3124677744138946, - -1.3915325370447373, - 0.04043109282734492 - ], - "translation_norm_m": 0.019132613866893196, - "rotation_rpy_deg_xyz": [ - 0.26607942486789343, - -0.0011306935488048103, - -0.7055129898317527 - ], - "rotation_angle_deg": 0.754018248105768, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.011253495473177999, - 0.019042130073736452, - -0.055107612575938485 - ], - "translation_xyz_cm": [ - 1.1253495473178, - 1.9042130073736452, - -5.510761257593848 - ], - "translation_norm_m": 0.05938091311128239, - "rotation_rpy_deg_xyz": [ - 0.6724342361616781, - 0.1991380288638787, - 0.14738650674218642 - ], - "rotation_angle_deg": 0.7163807313404517, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.01369910204393987, - 0.006614408444333364, - 0.0065438804824244495 - ], - "translation_xyz_cm": [ - 1.369910204393987, - 0.6614408444333364, - 0.6543880482424449 - ], - "translation_norm_m": 0.01656013791147289, - "rotation_rpy_deg_xyz": [ - 0.8753500770892035, - 1.0394229053510766, - 0.022063507124730194 - ], - "rotation_angle_deg": 1.3589529517594734, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.00411121069043574, - -0.018899792567178664, - -0.0022185752961888794 - ], - "translation_xyz_cm": [ - 0.41112106904357404, - -1.8899792567178664, - -0.22185752961888794 - ], - "translation_norm_m": 0.019468597503888012, - "rotation_rpy_deg_xyz": [ - -1.2402693290442983, - -1.0781453232472173, - 0.152342647244428 - ], - "rotation_angle_deg": 1.649324472884649, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.012864053152275234, - -0.002033913314195765, - 0.024209017760052035 - ], - "translation_xyz_cm": [ - 1.2864053152275234, - -0.2033913314195765, - 2.4209017760052034 - ], - "translation_norm_m": 0.027489947395015875, - "rotation_rpy_deg_xyz": [ - -0.08973298441744626, - -0.5566691943867748, - -0.12472292198404726 - ], - "rotation_angle_deg": 0.5775785269147343, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.006469669321735871, - -0.0291021444617085, - 0.020027206107760487 - ], - "translation_xyz_cm": [ - 0.6469669321735871, - -2.9102144461708503, - 2.0027206107760485 - ], - "translation_norm_m": 0.0359149052328623, - "rotation_rpy_deg_xyz": [ - 1.402620213898657, - 0.29762547060347594, - -0.18274552856634918 - ], - "rotation_angle_deg": 1.445906506535917, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0026693636364575335, - 0.019368734286264733, - -0.08119758952238089 - ], - "translation_xyz_cm": [ - 0.26693636364575335, - 1.9368734286264733, - -8.119758952238088 - ], - "translation_norm_m": 0.08351839267084005, - "rotation_rpy_deg_xyz": [ - 0.19710358064253639, - 1.75610058117313, - 0.09600993908803544 - ], - "rotation_angle_deg": 1.7695686469819443, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008889435615301311, - 0.022169523453340112, - 0.03728805497760439 - ], - "translation_xyz_cm": [ - -0.8889435615301311, - 2.216952345334011, - 3.7288054977604386 - ], - "translation_norm_m": 0.04428215080277416, - "rotation_rpy_deg_xyz": [ - 0.5841350263970084, - 0.9768943814020525, - -0.27328591197271557 - ], - "rotation_angle_deg": 1.1717220764190495, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0018180398786911134, - -0.03854448589011672, - -0.06257830235393858 - ], - "translation_xyz_cm": [ - 0.18180398786911134, - -3.854448589011672, - -6.2578302353938575 - ], - "translation_norm_m": 0.07351888592079502, - "rotation_rpy_deg_xyz": [ - 0.4158950594493795, - 0.6147340464840143, - -0.08637877645180222 - ], - "rotation_angle_deg": 0.74747014429346, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.005453518352689812, - 0.03274888599756931, - -0.05434322877906393 - ], - "translation_xyz_cm": [ - 0.5453518352689812, - 3.274888599756931, - -5.434322877906393 - ], - "translation_norm_m": 0.06368215535484488, - "rotation_rpy_deg_xyz": [ - 0.02494649099017262, - 1.629068976577437, - 0.22191505274763368 - ], - "rotation_angle_deg": 1.644254720263692, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017223482013195568, - 0.01398018280321267, - -0.07964670992551748 - ], - "translation_xyz_cm": [ - -1.7223482013195568, - 1.398018280321267, - -7.964670992551747 - ], - "translation_norm_m": 0.08267824529965327, - "rotation_rpy_deg_xyz": [ - 0.38087541031494304, - 0.1926322337604779, - 0.35980818176193247 - ], - "rotation_angle_deg": 0.5578294572261715, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.025439496786151317, - 0.012588279837440708, - -0.06880683199038565 - ], - "translation_xyz_cm": [ - -2.5439496786151317, - 1.2588279837440708, - -6.880683199038565 - ], - "translation_norm_m": 0.07443126301865015, - "rotation_rpy_deg_xyz": [ - 0.2203368179717307, - 0.4981733396540264, - 0.07918021245281688 - ], - "rotation_angle_deg": 0.5503112310748922, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.029228742962928767, - 0.01912026693016955, - -0.049451112292177295 - ], - "translation_xyz_cm": [ - -2.9228742962928767, - 1.912026693016955, - -4.945111229217729 - ], - "translation_norm_m": 0.060541857665646674, - "rotation_rpy_deg_xyz": [ - 0.6447447167996349, - 0.7607059856282655, - 0.3283511818598405 - ], - "rotation_angle_deg": 1.0485057357440128, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0039004619041316246, - -0.011088622382047664, - -0.06611278470322597 - ], - "translation_xyz_cm": [ - -0.39004619041316246, - -1.1088622382047664, - -6.611278470322597 - ], - "translation_norm_m": 0.06714961988434738, - "rotation_rpy_deg_xyz": [ - 1.0422239990255513, - 0.9991119625408407, - 0.5039134443027652 - ], - "rotation_angle_deg": 1.5261668355009212, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.02191518468137632, - -0.017746358075718005, - -0.026470398281598976 - ], - "translation_xyz_cm": [ - 2.191518468137632, - -1.7746358075718005, - -2.6470398281598975 - ], - "translation_norm_m": 0.03867674404286006, - "rotation_rpy_deg_xyz": [ - -0.21858520190102776, - 0.16138718092847754, - -0.23262171151186886 - ], - "rotation_angle_deg": 0.35748400774674627, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008325885277834344, - -0.0015001099449218902, - -0.044010185899365575 - ], - "translation_xyz_cm": [ - -0.8325885277834344, - -0.15001099449218902, - -4.401018589936558 - ], - "translation_norm_m": 0.044815925276660624, - "rotation_rpy_deg_xyz": [ - 0.8523268222819397, - 0.3980703773426894, - 0.2684864650828656 - ], - "rotation_angle_deg": 0.9774515806559808, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0034192070836858157, - -0.0028202542007176312, - 0.06143574090761021 - ], - "translation_xyz_cm": [ - 0.34192070836858157, - -0.2820254200717631, - 6.143574090761021 - ], - "translation_norm_m": 0.06159541437237681, - "rotation_rpy_deg_xyz": [ - 1.4085480860733448, - -0.08805897827643376, - -0.26762022434834903 - ], - "rotation_angle_deg": 1.4362448664346645, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.00892785637505833, - 0.006927300827181071, - 0.005120899894643427 - ], - "translation_xyz_cm": [ - -0.892785637505833, - 0.6927300827181071, - 0.5120899894643427 - ], - "translation_norm_m": 0.01240635852838746, - "rotation_rpy_deg_xyz": [ - 1.3335647252230216, - 0.9344036776620319, - 0.43805820242716587 - ], - "rotation_angle_deg": 1.6833955951335502, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0018819476719720285, - -0.006777998540105745, - -0.03867905733988866 - ], - "translation_xyz_cm": [ - -0.18819476719720285, - -0.6777998540105745, - -3.867905733988866 - ], - "translation_norm_m": 0.03931351508008552, - "rotation_rpy_deg_xyz": [ - -0.23120082287538518, - 1.046233419545519, - -0.2899155932215563 - ], - "rotation_angle_deg": 1.1094509209293886, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.009095390235534406, - 0.012530668665156064, - 0.14275378650405063 - ], - "translation_xyz_cm": [ - 0.9095390235534406, - 1.2530668665156064, - 14.275378650405063 - ], - "translation_norm_m": 0.14359104199767006, - "rotation_rpy_deg_xyz": [ - 1.9329653855190148, - -0.07996460925248046, - -0.4846755672150405 - ], - "rotation_angle_deg": 1.9940735879408271, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.005443535131559152, - 0.00094534408672442, - 0.08111055567070045 - ], - "translation_xyz_cm": [ - 0.5443535131559152, - 0.094534408672442, - 8.111055567070045 - ], - "translation_norm_m": 0.08129851161848303, - "rotation_rpy_deg_xyz": [ - 1.4481235766359781, - 0.5068569839045953, - 0.19821275527467014 - ], - "rotation_angle_deg": 1.5461885233635853, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.012728232625097924, - 0.008733273253230589, - 0.022939883134862768 - ], - "translation_xyz_cm": [ - 1.2728232625097924, - 0.8733273253230589, - 2.2939883134862766 - ], - "translation_norm_m": 0.027649886179067017, - "rotation_rpy_deg_xyz": [ - 1.0206699660638938, - 1.3398780076954988, - -0.49157657249477776 - ], - "rotation_angle_deg": 1.7579408906508507, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00703478859077844, - 0.04333335691384421, - 0.09278630515901494 - ], - "translation_xyz_cm": [ - -0.703478859077844, - 4.333335691384422, - 9.278630515901494 - ], - "translation_norm_m": 0.1026477788215673, - "rotation_rpy_deg_xyz": [ - -1.3040116224512142, - -0.2672137371486791, - 0.6221986297464478 - ], - "rotation_angle_deg": 1.468051828766713, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.025135302465596254, - 0.027399805853963066, - 0.07152812418583711 - ], - "translation_xyz_cm": [ - 2.5135302465596254, - 2.7399805853963066, - 7.152812418583711 - ], - "translation_norm_m": 0.0806151681783051, - "rotation_rpy_deg_xyz": [ - -0.6073336536013624, - 0.11508655141088435, - 0.5029473967263434 - ], - "rotation_angle_deg": 0.7972867364345844, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.004198232914469413, - -0.02952719010311894, - 0.011571216197554246 - ], - "translation_xyz_cm": [ - -0.4198232914469413, - -2.9527190103118937, - 1.1571216197554246 - ], - "translation_norm_m": 0.03199020411439103, - "rotation_rpy_deg_xyz": [ - 0.05574056469057366, - -0.462236021971166, - -0.12224388381394627 - ], - "rotation_angle_deg": 0.48130826592399256, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.021089887155215425, - 0.03278562131568741, - -0.04547532937847744 - ], - "translation_xyz_cm": [ - -2.1089887155215425, - 3.2785621315687408, - -4.547532937847744 - ], - "translation_norm_m": 0.05989729449112364, - "rotation_rpy_deg_xyz": [ - -1.0567134611003934, - -0.29973577355023784, - -0.0596605010635514 - ], - "rotation_angle_deg": 1.100168805099641, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012056998911066152, - 0.04061472076341466, - 0.0025009250381939074 - ], - "translation_xyz_cm": [ - 1.2056998911066152, - 4.061472076341466, - 0.25009250381939074 - ], - "translation_norm_m": 0.042440327419545926, - "rotation_rpy_deg_xyz": [ - -0.5343684106860617, - 0.1373397404850529, - -0.07177661369176375 - ], - "rotation_angle_deg": 0.5563016896524537, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.0002534687384057044, - -0.006073219869567048, - 0.03510010089521605 - ], - "translation_xyz_cm": [ - 0.02534687384057044, - -0.6073219869567048, - 3.510010089521605 - ], - "translation_norm_m": 0.03562253961805362, - "rotation_rpy_deg_xyz": [ - 0.2698539805257798, - -1.0247583957555129, - 0.2333510922145914 - ], - "rotation_angle_deg": 1.0855995745702556, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.015505711385465304, - 0.006312183028594376, - 0.04000893126358634 - ], - "translation_xyz_cm": [ - -1.5505711385465304, - 0.6312183028594376, - 4.000893126358633 - ], - "translation_norm_m": 0.043370327656246724, - "rotation_rpy_deg_xyz": [ - -0.7738228517454108, - -0.777161880829198, - 0.17092217593129932 - ], - "rotation_angle_deg": 1.1091405167766242, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.006248289278996011, - 0.023974685759312497, - -0.03449358844562024 - ], - "translation_xyz_cm": [ - 0.6248289278996011, - 2.3974685759312497, - -3.449358844562024 - ], - "translation_norm_m": 0.04246921614566984, - "rotation_rpy_deg_xyz": [ - -0.002083789809453343, - 0.08802705628236235, - 0.1067815027116175 - ], - "rotation_angle_deg": 0.13840424036252938, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.018100019708132242, - 0.022016231874761094, - -0.07453220157837337 - ], - "translation_xyz_cm": [ - 1.8100019708132242, - 2.2016231874761094, - -7.453220157837337 - ], - "translation_norm_m": 0.07979582853456253, - "rotation_rpy_deg_xyz": [ - 0.917911325208971, - 0.17545459664890692, - 0.11306815631730455 - ], - "rotation_angle_deg": 0.9411754146481723, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.007941621015630007, - 0.0036536192561402725, - -0.008158821100640534 - ], - "translation_xyz_cm": [ - -0.7941621015630007, - 0.36536192561402725, - -0.8158821100640534 - ], - "translation_norm_m": 0.01195761848266587, - "rotation_rpy_deg_xyz": [ - 0.08366353686583815, - 0.007815254330928759, - -0.05218799147943881 - ], - "rotation_angle_deg": 0.09891838615356956, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.019326980971161367, - 0.029995031178731146, - -0.05428562336780522 - ], - "translation_xyz_cm": [ - 1.9326980971161367, - 2.9995031178731146, - -5.428562336780522 - ], - "translation_norm_m": 0.06496278160072802, - "rotation_rpy_deg_xyz": [ - 0.5571516664167842, - 0.5586956276312934, - -0.13800750110025364 - ], - "rotation_angle_deg": 0.8014685674873386, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.023559303330794368, - 0.025041019068133386, - 0.01690296612957995 - ], - "translation_xyz_cm": [ - 2.355930333079437, - 2.5041019068133386, - 1.690296612957995 - ], - "translation_norm_m": 0.03831192599414346, - "rotation_rpy_deg_xyz": [ - 0.9123288218127654, - 0.4099135111384947, - -0.08378526157719915 - ], - "rotation_angle_deg": 1.0039601998750125, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0004326837264558847, - -0.0004498436756477098, - 0.00824903820209413 - ], - "translation_xyz_cm": [ - -0.04326837264558847, - -0.04498436756477098, - 0.824903820209413 - ], - "translation_norm_m": 0.008272617832298814, - "rotation_rpy_deg_xyz": [ - 0.5994303530109166, - -0.022197391521863105, - 0.006584046200398296 - ], - "rotation_angle_deg": 0.5998786094597935, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.1513744090652973, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10792431432082006, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0024476764333135033, - 0.7204936800355414 - ], - "rotation_rpy_deg_xyz": [ - -0.9851737312819089, - 1.1997371245619126, - -0.8397031987625543 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.12043024872839399, - "median": 0.0643739355081696, - "p90": 0.1927474091888426, - "p95": 0.2363622322834748, - "max": 0.39635222213424975 - }, - "rotation_deg": { - "rms": 1.1611526935950138, - "median": 0.9368128037961176, - "p90": 1.669468762063234, - "p95": 2.2380866220909357, - "max": 2.8903005923866907 - }, - "normalized_pair_score": { - "rms": 3.3458153318563415, - "median": 2.3707149077862573, - "p90": 5.098887952792406, - "p95": 5.9065266353898025, - "max": 8.537660940555527 - }, - "normalized_global_rms": 3.3458153318563415 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.017820119718393812, - 0.021040953752552438, - 0.08587941238077568 - ], - "translation_xyz_cm": [ - -1.7820119718393812, - 2.104095375255244, - 8.587941238077567 - ], - "translation_norm_m": 0.09019729415266439, - "rotation_rpy_deg_xyz": [ - 0.36478305373442976, - 0.1435516883850566, - 0.09519676608407507 - ], - "rotation_angle_deg": 0.4032977537513619, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7107124278398285, - "median": 0.7334463903250042, - "p90": 2.3653698912452787, - "p95": 4.0266291870908315, - "max": 5.724141872865437 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.017820119718393812, - 0.021040953752552438, - 0.08587941238077568 - ], - "translation_xyz_cm": [ - -1.7820119718393812, - 2.104095375255244, - 8.587941238077567 - ], - "translation_norm_m": 0.09019729415266439, - "rotation_rpy_deg_xyz": [ - 0.36478305373442976, - 0.1435516883850566, - 0.09519676608407507 - ], - "rotation_angle_deg": 0.4032977537513619, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.02043503606098307, - -0.023038214605786367, - 0.17092471488741035 - ], - "translation_xyz_cm": [ - 2.043503606098307, - -2.3038214605786367, - 17.092471488741033 - ], - "translation_norm_m": 0.17367673474123832, - "rotation_rpy_deg_xyz": [ - -0.41592983058545757, - -0.2387976611637958, - -0.35576698087416175 - ], - "rotation_angle_deg": 0.5976686618982571, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03122663805447712, - 0.0047862174304376115, - 0.15041453453138878 - ], - "translation_xyz_cm": [ - 3.122663805447712, - 0.47862174304376115, - 15.041453453138878 - ], - "translation_norm_m": 0.1536962686592329, - "rotation_rpy_deg_xyz": [ - -0.14630120395950016, - -0.14321218113977194, - -0.39123880975401476 - ], - "rotation_angle_deg": 0.4417289586304836, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.007684475521751229, - 0.0017496746876055624, - 0.10251821086321303 - ], - "translation_xyz_cm": [ - -0.7684475521751228, - 0.17496746876055624, - 10.251821086321304 - ], - "translation_norm_m": 0.10282069871456355, - "rotation_rpy_deg_xyz": [ - 0.4250683131023627, - 0.2695379329939962, - 0.20320720908381765 - ], - "rotation_angle_deg": 0.5424204955658971, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.01804691692759608, - -0.0005394143408343766, - -0.025411690543140006 - ], - "translation_xyz_cm": [ - -1.804691692759608, - -0.053941434083437656, - -2.5411690543140004 - ], - "translation_norm_m": 0.031172683469392927, - "rotation_rpy_deg_xyz": [ - 0.36977106612777366, - 0.046725171177846095, - 0.05648136948455327 - ], - "rotation_angle_deg": 0.37694426273465614, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03146541626289434, - -0.017806918514554293, - 0.07447064177517491 - ], - "translation_xyz_cm": [ - 3.146541626289434, - -1.7806918514554293, - 7.4470641775174915 - ], - "translation_norm_m": 0.08278306139535804, - "rotation_rpy_deg_xyz": [ - 0.3567200012980473, - 0.10712053896155983, - -0.34341013060561026 - ], - "rotation_angle_deg": 0.5068363283621755, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04367598795586081, - 0.007052759369959749, - 0.06434809065394831 - ], - "translation_xyz_cm": [ - 4.367598795586081, - 0.7052759369959749, - 6.43480906539483 - ], - "translation_norm_m": 0.07808975675118858, - "rotation_rpy_deg_xyz": [ - 0.652940927623696, - 0.458943514963637, - -0.35894023700232347 - ], - "rotation_angle_deg": 0.8761689514363343, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.001635804814664965, - -0.002387583385129899, - 0.0010867721729665852 - ], - "translation_xyz_cm": [ - 0.1635804814664965, - -0.2387583385129899, - 0.10867721729665852 - ], - "translation_norm_m": 0.0030915183273860667, - "rotation_rpy_deg_xyz": [ - 0.7879903160759685, - 0.43696879192940824, - 0.023006847668494163 - ], - "rotation_angle_deg": 0.9012538459713609, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005607998337189422, - 0.01966898732315031, - 0.0009178388872627964 - ], - "translation_xyz_cm": [ - 0.5607998337189422, - 1.966898732315031, - 0.09178388872627964 - ], - "translation_norm_m": 0.020473425113818614, - "rotation_rpy_deg_xyz": [ - 0.3286551277025404, - 0.28749324090829537, - -0.02435943094337639 - ], - "rotation_angle_deg": 0.4373784172807165, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03772586977720217, - -0.0014575639728397483, - -0.035426503365517885 - ], - "translation_xyz_cm": [ - -3.7725869777202172, - -0.14575639728397483, - -3.5426503365517883 - ], - "translation_norm_m": 0.05177260746657818, - "rotation_rpy_deg_xyz": [ - 0.6516256854286535, - 1.0232023140306439, - 0.5783172867507906 - ], - "rotation_angle_deg": 1.3413635966819077, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04894243765359735, - -0.023480574308893498, - -0.044769409118677134 - ], - "translation_xyz_cm": [ - -4.894243765359735, - -2.34805743088935, - -4.476940911867714 - ], - "translation_norm_m": 0.07036333964634726, - "rotation_rpy_deg_xyz": [ - 0.6818306387847469, - 1.5943155637793636, - 0.4953961614630312 - ], - "rotation_angle_deg": 1.8007511720438438, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03237081212511922, - -0.019530764174311543, - -0.04314032047273718 - ], - "translation_xyz_cm": [ - -3.2370812125119217, - -1.9530764174311543, - -4.3140320472737175 - ], - "translation_norm_m": 0.05736207350996653, - "rotation_rpy_deg_xyz": [ - 0.503313925374934, - 0.576919941095541, - 0.599902156587377 - ], - "rotation_angle_deg": 0.9710799952927553, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.039298403740209285, - -0.039429072635745355, - -0.052426391135013004 - ], - "translation_xyz_cm": [ - -3.9298403740209285, - -3.9429072635745355, - -5.2426391135013 - ], - "translation_norm_m": 0.0764692277513298, - "rotation_rpy_deg_xyz": [ - 0.6736289679251903, - 1.1302784960659087, - 0.5201411270232629 - ], - "rotation_angle_deg": 1.4124141157765373, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.011824453269450988, - -0.012853424291757565, - -0.010494770382958672 - ], - "translation_xyz_cm": [ - -1.1824453269450987, - -1.2853424291757565, - -1.0494770382958671 - ], - "translation_norm_m": 0.02037568198947952, - "rotation_rpy_deg_xyz": [ - 0.3767855509882373, - 0.4123630175968183, - -0.0858978371276618 - ], - "rotation_angle_deg": 0.5653506091344966, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.01006180452805594, - -0.010423145139379905, - -0.19012609959435703 - ], - "translation_xyz_cm": [ - 1.006180452805594, - -1.0423145139379906, - -19.012609959435704 - ], - "translation_norm_m": 0.19067725509855848, - "rotation_rpy_deg_xyz": [ - -1.0231425488583996, - 0.25413784672092576, - 0.3276655469900528 - ], - "rotation_angle_deg": 1.1046509380385467, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0009934392725573504, - 0.011685930317659797, - -0.23453732033900698 - ], - "translation_xyz_cm": [ - 0.09934392725573504, - 1.1685930317659796, - -23.4537320339007 - ], - "translation_norm_m": 0.234830369673046, - "rotation_rpy_deg_xyz": [ - -0.6466062587483297, - -0.05825514715442281, - 0.43052873872525077 - ], - "rotation_angle_deg": 0.7788217047622377, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.004149539233526456, - 0.003715931195123312, - -0.02402808715310513 - ], - "translation_xyz_cm": [ - -0.4149539233526456, - 0.3715931195123312, - -2.402808715310513 - ], - "translation_norm_m": 0.024665275038699277, - "rotation_rpy_deg_xyz": [ - -0.06534489616672208, - 0.1213021335190503, - -0.09997563808212566 - ], - "rotation_angle_deg": 0.17019240262321322, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0013541860018620039, - 0.030143877445495182, - -0.263747172686852 - ], - "translation_xyz_cm": [ - 0.1354186001862004, - 3.014387744549518, - -26.3747172686852 - ], - "translation_norm_m": 0.2654676218816238, - "rotation_rpy_deg_xyz": [ - -0.9142721720396845, - 0.08694416390597687, - 0.06252461917257231 - ], - "rotation_angle_deg": 0.9205697806708228, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.001681379328700272, - 0.015418761340728948, - -0.162315385962531 - ], - "translation_xyz_cm": [ - -0.1681379328700272, - 1.5418761340728948, - -16.2315385962531 - ], - "translation_norm_m": 0.1630547446653876, - "rotation_rpy_deg_xyz": [ - -0.5487346333606373, - 0.815158007223054, - 0.2763336739874524 - ], - "rotation_angle_deg": 1.0218135579003458, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.007902081375799896, - 0.027965661623003957, - 0.00551840307009778 - ], - "translation_xyz_cm": [ - 0.7902081375799896, - 2.7965661623003957, - 0.5518403070097779 - ], - "translation_norm_m": 0.029579957615354768, - "rotation_rpy_deg_xyz": [ - 0.18195732747617288, - -0.672449375460191, - -0.25023023697661567 - ], - "rotation_angle_deg": 0.7398488200049607, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.0128861340936961, - -0.027911139701880534, - -0.025805848006329624 - ], - "translation_xyz_cm": [ - -1.28861340936961, - -2.7911139701880536, - -2.5805848006329626 - ], - "translation_norm_m": 0.04013758790291708, - "rotation_rpy_deg_xyz": [ - 0.041433175042003785, - -0.2430064267371472, - -0.4792102930691399 - ], - "rotation_angle_deg": 0.5388197921984597, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00640405114340048, - 0.009062115538044369, - -0.007120953172815895 - ], - "translation_xyz_cm": [ - 0.640405114340048, - 0.9062115538044369, - -0.7120953172815895 - ], - "translation_norm_m": 0.013184907400569445, - "rotation_rpy_deg_xyz": [ - 0.3889077312352339, - -0.4682795598473013, - -0.48125419406362546 - ], - "rotation_angle_deg": 0.7749889403294858, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01898607590342405, - 0.013881114545722273, - -0.1982538820488282 - ], - "translation_xyz_cm": [ - -1.898607590342405, - 1.3881114545722273, - -19.82538820488282 - ], - "translation_norm_m": 0.19964407871678222, - "rotation_rpy_deg_xyz": [ - -0.8759068419475823, - 1.1414085788439683, - -0.6453743797531083 - ], - "rotation_angle_deg": 1.5732850603048087, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.029090890636235094, - 0.02764392107554281, - -0.21782385221719114 - ], - "translation_xyz_cm": [ - -2.9090890636235094, - 2.764392107554281, - -21.782385221719114 - ], - "translation_norm_m": 0.22148972184996973, - "rotation_rpy_deg_xyz": [ - -0.44676222582058145, - 0.9909184003781908, - -0.4162585004400608 - ], - "rotation_angle_deg": 1.1625663175493357, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011663753437640645, - 0.03051729270640291, - -0.036960056916049706 - ], - "translation_xyz_cm": [ - 1.1663753437640645, - 3.051729270640291, - -3.6960056916049706 - ], - "translation_norm_m": 0.04932944461090131, - "rotation_rpy_deg_xyz": [ - 0.34385775863294193, - -0.06734139049857096, - -0.011111234223459353 - ], - "rotation_angle_deg": 0.3505595185066412, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012874917904443839, - 0.045030319544111075, - -0.13870637650489492 - ], - "translation_xyz_cm": [ - 1.2874917904443839, - 4.5030319544111075, - -13.870637650489492 - ], - "translation_norm_m": 0.1463999729248902, - "rotation_rpy_deg_xyz": [ - -0.5585836843037377, - -0.18044831171483336, - 0.162770908554501 - ], - "rotation_angle_deg": 0.6089210588306129, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006099375008575769, - 0.018722870815474857, - -0.08910605779189963 - ], - "translation_xyz_cm": [ - 0.6099375008575769, - 1.8722870815474857, - -8.910605779189963 - ], - "translation_norm_m": 0.09125589187708132, - "rotation_rpy_deg_xyz": [ - -0.7589300130379728, - -0.08623682137705985, - 0.16175025058092193 - ], - "rotation_angle_deg": 0.7806339972397327, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.009807243440260738, - -0.02437447801585968, - -0.16678796196961618 - ], - "translation_xyz_cm": [ - -0.9807243440260738, - -2.437447801585968, - -16.678796196961617 - ], - "translation_norm_m": 0.16884466666264675, - "rotation_rpy_deg_xyz": [ - -0.8923026310879985, - 2.379514179501999, - -0.3740957027649275 - ], - "rotation_angle_deg": 2.5659771664948217, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004626470779444003, - 0.02103791081169204, - -0.024050168839813667 - ], - "translation_xyz_cm": [ - 0.4626470779444003, - 2.103791081169204, - -2.4050168839813666 - ], - "translation_norm_m": 0.03228635229345834, - "rotation_rpy_deg_xyz": [ - 0.988596916875822, - 0.160948204782543, - 0.22112626945301578 - ], - "rotation_angle_deg": 1.0254311534347378, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.008505431603111235, - 0.036907601273432844, - 0.0589833772762806 - ], - "translation_xyz_cm": [ - 0.8505431603111235, - 3.6907601273432844, - 5.89833772762806 - ], - "translation_norm_m": 0.07009673454184552, - "rotation_rpy_deg_xyz": [ - 1.0946190330664627, - 1.6961526962572704, - 0.15763695375994613 - ], - "rotation_angle_deg": 2.023555282851833, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.012716714579586341, - 0.008061448911876656, - -0.02776144775596911 - ], - "translation_xyz_cm": [ - -1.2716714579586341, - 0.8061448911876656, - -2.7761447755969106 - ], - "translation_norm_m": 0.03158163659098216, - "rotation_rpy_deg_xyz": [ - -0.3935627171747256, - 2.4734357951482058, - 0.684668313981457 - ], - "rotation_angle_deg": 2.5986690287599568, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.006208927327609692, - 0.006053614838600563, - 0.393881730684372 - ], - "translation_xyz_cm": [ - 0.6208927327609692, - 0.6053614838600563, - 39.3881730684372 - ], - "translation_norm_m": 0.3939771754785927, - "rotation_rpy_deg_xyz": [ - -1.5947745695392421, - 0.39191983787199886, - -0.07060822087859539 - ], - "rotation_angle_deg": 1.6435060401966557, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011740820589012158, - 0.03706886415750199, - 0.048865991709316964 - ], - "translation_xyz_cm": [ - 1.1740820589012158, - 3.706886415750199, - 4.886599170931697 - ], - "translation_norm_m": 0.062448640527762826, - "rotation_rpy_deg_xyz": [ - 1.4039552618603215, - -0.3022521041102216, - 0.05916373147687582 - ], - "rotation_angle_deg": 1.4374910390962987, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0055529660144857385, - 0.019640518631361292, - 0.001360912837626375 - ], - "translation_xyz_cm": [ - -0.5552966014485738, - 1.9640518631361292, - 0.13609128376263752 - ], - "translation_norm_m": 0.02045574460679689, - "rotation_rpy_deg_xyz": [ - -0.1290503242638148, - 2.1648802330184678, - 0.48317405300819627 - ], - "rotation_angle_deg": 2.2224184377303375, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.029761922906245797, - 0.028184821286481476, - 0.15482522238027266 - ], - "translation_xyz_cm": [ - 2.9761922906245797, - 2.8184821286481476, - 15.482522238027267 - ], - "translation_norm_m": 0.16015931346983572, - "rotation_rpy_deg_xyz": [ - -0.37110540243753076, - -0.7903138065849322, - -0.30537343861057564 - ], - "rotation_angle_deg": 0.9258116702785261, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0038084266203121317, - 0.015233902691625278, - 0.39604104343643154 - ], - "translation_xyz_cm": [ - 0.3808426620312132, - 1.5233902691625278, - 39.60410434364315 - ], - "translation_norm_m": 0.39635222213424975, - "rotation_rpy_deg_xyz": [ - -0.9158466463776106, - 0.4194336612056492, - -0.25307677123819905 - ], - "rotation_angle_deg": 1.0378079739899322, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.014771260941798925, - 0.013730297099735722, - 0.05389700129061329 - ], - "translation_xyz_cm": [ - -1.4771260941798925, - 1.3730297099735722, - 5.389700129061329 - ], - "translation_norm_m": 0.05754648517831559, - "rotation_rpy_deg_xyz": [ - 0.7224775522536888, - 2.738531007646283, - 0.5941376308356888 - ], - "rotation_angle_deg": 2.8903005923866907, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0335803271190972, - 0.00715807762085241, - 0.18888586802812932 - ], - "translation_xyz_cm": [ - 3.3580327119097197, - 0.715807762085241, - 18.88858680281293 - ], - "translation_norm_m": 0.191981112574627, - "rotation_rpy_deg_xyz": [ - -0.011274780219796627, - -0.16364401898719588, - -0.23065477561299694 - ], - "rotation_angle_deg": 0.2830468199793559, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.035631984698194286, - 0.014792236793750746, - 0.3261679600320263 - ], - "translation_xyz_cm": [ - 3.5631984698194286, - 1.4792236793750746, - 32.61679600320263 - ], - "translation_norm_m": 0.32844175549760457, - "rotation_rpy_deg_xyz": [ - -0.23447232071276777, - 0.01649325228687634, - -0.24544999264921663 - ], - "rotation_angle_deg": 0.3398210467035202, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0287516569077082, - 0.019474296184412543, - 0.07561807304083318 - ], - "translation_xyz_cm": [ - 2.87516569077082, - 1.9474296184412543, - 7.561807304083318 - ], - "translation_norm_m": 0.0832105699849819, - "rotation_rpy_deg_xyz": [ - 0.8264579627220295, - -2.2687975789474635, - -0.7910664536492354 - ], - "rotation_angle_deg": 2.535782124942318, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009955753865009243, - 0.02714692437243338, - 0.21611525081405109 - ], - "translation_xyz_cm": [ - -0.9955753865009243, - 2.714692437243338, - 21.61152508140511 - ], - "translation_norm_m": 0.21804099195408985, - "rotation_rpy_deg_xyz": [ - 0.5386747728538959, - -0.5962082194544377, - -0.7349498439463366 - ], - "rotation_angle_deg": 1.0870395164127264, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.001940133103333963, - -0.020499103819731967, - 0.1665915498776484 - ], - "translation_xyz_cm": [ - -0.1940133103333963, - -2.0499103819731967, - 16.65915498776484 - ], - "translation_norm_m": 0.16785923228856917, - "rotation_rpy_deg_xyz": [ - -1.0679097839121303, - 0.5870526343874813, - -0.02687337193965722 - ], - "rotation_angle_deg": 1.2188027866779128, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.005273631815791713, - -0.007158615714975003, - -0.05751816320969266 - ], - "translation_xyz_cm": [ - 0.5273631815791713, - -0.7158615714975003, - -5.751816320969266 - ], - "translation_norm_m": 0.058201340796411725, - "rotation_rpy_deg_xyz": [ - -0.5063074017770353, - 0.49507290678297095, - 0.08653273757291471 - ], - "rotation_angle_deg": 0.7136589929659574, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0013544748384002325, - 0.028712427174605315, - 0.06826796982536457 - ], - "translation_xyz_cm": [ - 0.13544748384002325, - 2.8712427174605315, - 6.8267969825364565 - ], - "translation_norm_m": 0.07407262504071095, - "rotation_rpy_deg_xyz": [ - -0.8615102083489585, - 0.10149139152144565, - -0.718576918281085 - ], - "rotation_angle_deg": 1.1259424904253126, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014439873043226026, - -0.042351568721263444, - -0.013963186194489285 - ], - "translation_xyz_cm": [ - 1.4439873043226026, - -4.235156872126344, - -1.3963186194489285 - ], - "translation_norm_m": 0.04687361598339051, - "rotation_rpy_deg_xyz": [ - 0.05208905312564062, - 0.3467404459459039, - -0.628817115461452 - ], - "rotation_angle_deg": 0.7201042640351974, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.020294849346330857, - -0.014977838200889604, - 0.0032927775232107215 - ], - "translation_xyz_cm": [ - -2.0294849346330857, - -1.4977838200889604, - 0.32927775232107215 - ], - "translation_norm_m": 0.02543735306551481, - "rotation_rpy_deg_xyz": [ - 0.3356196720053142, - -0.5483153316833131, - -0.7152227785120473 - ], - "rotation_angle_deg": 0.9604845005988879, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012382196983462546, - 0.022760676443891237, - -0.07159288412769056 - ], - "translation_xyz_cm": [ - 1.2382196983462546, - 2.2760676443891237, - -7.159288412769056 - ], - "translation_norm_m": 0.07613743003307705, - "rotation_rpy_deg_xyz": [ - 0.4093015729609182, - 0.25054687580786084, - 0.1424602372801501 - ], - "rotation_angle_deg": 0.5003409535334158, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.007701689283505286, - 0.004503977473181209, - 0.02009184154266727 - ], - "translation_xyz_cm": [ - 0.7701689283505286, - 0.4503977473181209, - 2.0091841542667273 - ], - "translation_norm_m": 0.021983719600518797, - "rotation_rpy_deg_xyz": [ - 1.0014729636370108, - 0.5742831530677989, - 0.010215650572116217 - ], - "rotation_angle_deg": 1.1544447377318332, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0058944470234374435, - -0.016751355295740677, - -0.02753821000438067 - ], - "translation_xyz_cm": [ - 0.5894447023437444, - -1.6751355295740677, - -2.7538210004380668 - ], - "translation_norm_m": 0.032767444517411204, - "rotation_rpy_deg_xyz": [ - -1.4300261692065717, - -1.0205641917712303, - 0.14741373235997715 - ], - "rotation_angle_deg": 1.7619438811310486, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.013008077134297968, - 0.003828431903616869, - 0.017133978300751515 - ], - "translation_xyz_cm": [ - 1.3008077134297968, - 0.3828431903616869, - 1.7133978300751516 - ], - "translation_norm_m": 0.02185040443522959, - "rotation_rpy_deg_xyz": [ - -0.5280547225795502, - -0.5930514314995733, - -0.13543252181189172 - ], - "rotation_angle_deg": 0.8059970308325334, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0008216911814109551, - -0.023523121355248366, - 0.03159776503555092 - ], - "translation_xyz_cm": [ - -0.08216911814109551, - -2.3523121355248366, - 3.159776503555092 - ], - "translation_norm_m": 0.03940090316139003, - "rotation_rpy_deg_xyz": [ - 0.9425343002282909, - -0.24943604587357895, - -0.21328084117258264 - ], - "rotation_angle_deg": 0.9975972675902816, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.003827070743432026, - 0.01809177108110438, - -0.06366811848995584 - ], - "translation_xyz_cm": [ - -0.3827070743432026, - 1.809177108110438, - -6.366811848995583 - ], - "translation_norm_m": 0.06629923048857636, - "rotation_rpy_deg_xyz": [ - 0.28032187396545644, - 1.2249538103136999, - 0.08753523794580777 - ], - "rotation_angle_deg": 1.2594549207850616, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007858657666723667, - 0.02527424268550904, - 0.04804670880955959 - ], - "translation_xyz_cm": [ - -0.7858657666723667, - 2.527424268550904, - 4.8046708809559595 - ], - "translation_norm_m": 0.05485464493622553, - "rotation_rpy_deg_xyz": [ - 0.3233367801678781, - 1.0287442677214296, - -0.27822391202300883 - ], - "rotation_angle_deg": 1.1143967530732326, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.00045633926223542787, - -0.03233229698122586, - -0.06854974924682251 - ], - "translation_xyz_cm": [ - 0.04563392622354279, - -3.233229698122586, - -6.854974924682251 - ], - "translation_norm_m": 0.07579349441348306, - "rotation_rpy_deg_xyz": [ - -0.08401688495465622, - 0.5054344066989191, - -0.10017915964994509 - ], - "rotation_angle_deg": 0.5220002677879693, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0018833706507752623, - 0.03687061861914742, - -0.058785738026392836 - ], - "translation_xyz_cm": [ - -0.18833706507752623, - 3.687061861914742, - -5.878573802639283 - ], - "translation_norm_m": 0.06941723559516405, - "rotation_rpy_deg_xyz": [ - -0.32048611821892925, - 0.9982632882839529, - 0.20562832589479463 - ], - "rotation_angle_deg": 1.0689566723141521, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0210840959697709, - 0.01236790302830737, - -0.07617139491974625 - ], - "translation_xyz_cm": [ - -2.10840959697709, - 1.236790302830737, - -7.617139491974625 - ], - "translation_norm_m": 0.07999740953430973, - "rotation_rpy_deg_xyz": [ - 0.5457904702867811, - -0.10968367500644761, - 0.35657105277799706 - ], - "rotation_angle_deg": 0.6613865180973416, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.025571612851681635, - 0.01755176647209089, - -0.08110513474718899 - ], - "translation_xyz_cm": [ - -2.5571612851681635, - 1.755176647209089, - -8.110513474718898 - ], - "translation_norm_m": 0.08683325844678862, - "rotation_rpy_deg_xyz": [ - -0.17650281147310729, - 0.49457529448708076, - 0.06976326216819749 - ], - "rotation_angle_deg": 0.529840484094271, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03124344946432356, - 0.025402150444862714, - -0.05514341074118921 - ], - "translation_xyz_cm": [ - -3.124344946432356, - 2.5402150444862714, - -5.514341074118921 - ], - "translation_norm_m": 0.06828043738747344, - "rotation_rpy_deg_xyz": [ - 0.12214891036222668, - 0.6100989530482674, - 0.3126840701090961 - ], - "rotation_angle_deg": 0.6960636578528056, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.011936222766765203, - -0.008914228858869278, - -0.05849359022273362 - ], - "translation_xyz_cm": [ - -1.1936222766765203, - -0.8914228858869278, - -5.8493590222733625 - ], - "translation_norm_m": 0.06036088954970114, - "rotation_rpy_deg_xyz": [ - 0.8443119529877682, - 0.3361589920966088, - 0.4780596223547921 - ], - "rotation_angle_deg": 1.025685902130762, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014012626597881939, - -0.017507453362155534, - -0.012629809778516396 - ], - "translation_xyz_cm": [ - 1.4012626597881939, - -1.7507453362155534, - -1.2629809778516397 - ], - "translation_norm_m": 0.025736680486053903, - "rotation_rpy_deg_xyz": [ - -0.23904246173944468, - -0.4566355984381048, - -0.24020841886268415 - ], - "rotation_angle_deg": 0.5690469109893758, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007732796156189936, - 0.000763302284759515, - -0.041906392746926854 - ], - "translation_xyz_cm": [ - -0.7732796156189936, - 0.0763302284759515, - -4.1906392746926855 - ], - "translation_norm_m": 0.042620705294853914, - "rotation_rpy_deg_xyz": [ - 0.6675621527155255, - 0.4556730295176077, - 0.26578360195829404 - ], - "rotation_angle_deg": 0.8500020374783283, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0001821555999765856, - 0.004815672694442608, - 0.04674134173282837 - ], - "translation_xyz_cm": [ - 0.01821555999765856, - 0.48156726944426076, - 4.674134173282837 - ], - "translation_norm_m": 0.04698911481553623, - "rotation_rpy_deg_xyz": [ - 0.8526970641760465, - -0.3846007308793517, - -0.2911902399544982 - ], - "rotation_angle_deg": 0.9788413771192329, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01448727324306276, - 0.013467019004547165, - 0.005085366563855762 - ], - "translation_xyz_cm": [ - -1.448727324306276, - 1.3467019004547165, - 0.5085366563855762 - ], - "translation_norm_m": 0.020423090852678953, - "rotation_rpy_deg_xyz": [ - 0.805596560260417, - 0.4919899446572937, - 0.41048737012819286 - ], - "rotation_angle_deg": 1.027955468877894, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.00936575613716073, - -0.0015204596079771981, - -0.031164836492429557 - ], - "translation_xyz_cm": [ - -0.936575613716073, - -0.15204596079771981, - -3.1164836492429555 - ], - "translation_norm_m": 0.0325772346745411, - "rotation_rpy_deg_xyz": [ - -0.6475116162555878, - 0.4582765396058838, - -0.30432939964603417 - ], - "rotation_angle_deg": 0.8487197432789874, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.008042658470780228, - 0.019262656348529195, - 0.13719801734016546 - ], - "translation_xyz_cm": [ - 0.8042658470780228, - 1.9262656348529195, - 13.719801734016546 - ], - "translation_norm_m": 0.13877690819063337, - "rotation_rpy_deg_xyz": [ - 1.4319272086086583, - -0.19092068948382443, - -0.5014862811494135 - ], - "rotation_angle_deg": 1.5283804136765906, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.002477353509268365, - 0.008256433563550658, - 0.07135132161097885 - ], - "translation_xyz_cm": [ - 0.24773535092683652, - 0.8256433563550658, - 7.135132161097885 - ], - "translation_norm_m": 0.0718701403312429, - "rotation_rpy_deg_xyz": [ - 0.8957163973974445, - 0.2563502037237678, - 0.1761703902416161 - ], - "rotation_angle_deg": 0.9478139373137093, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.007347600162853851, - 0.01577546809356578, - 0.01790293606537527 - ], - "translation_xyz_cm": [ - 0.7347600162853851, - 1.577546809356578, - 1.790293606537527 - ], - "translation_norm_m": 0.02496733348768339, - "rotation_rpy_deg_xyz": [ - 0.48842753237589753, - 0.9075345570740905, - -0.5165217297341773 - ], - "rotation_angle_deg": 1.1545384261984166, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008326284676892115, - 0.04148749503145133, - 0.08368020297937732 - ], - "translation_xyz_cm": [ - -0.8326284676892115, - 4.148749503145133, - 8.368020297937733 - ], - "translation_norm_m": 0.09377054778114041, - "rotation_rpy_deg_xyz": [ - -1.1808800511492301, - -0.40162285407730214, - 0.6259365734528001 - ], - "rotation_angle_deg": 1.393690354652089, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.020048467599337094, - 0.025275037501994557, - 0.06766718712313417 - ], - "translation_xyz_cm": [ - 2.0048467599337094, - 2.5275037501994557, - 6.766718712313417 - ], - "translation_norm_m": 0.0749641033226314, - "rotation_rpy_deg_xyz": [ - -0.4581278868717242, - -0.29310696967787947, - 0.5039402998859618 - ], - "rotation_angle_deg": 0.7406519188032128, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.00701150391569505, - -0.03146319929437369, - 0.010640143444274441 - ], - "translation_xyz_cm": [ - -0.701150391569505, - -3.146319929437369, - 1.0640143444274441 - ], - "translation_norm_m": 0.03394564404326453, - "rotation_rpy_deg_xyz": [ - 0.21236817063902336, - -0.6882602020161982, - -0.12257877961796673 - ], - "rotation_angle_deg": 0.7304207401527828, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.028872884529772547, - 0.036549345155857615, - -0.04905984198491668 - ], - "translation_xyz_cm": [ - -2.8872884529772547, - 3.6549345155857615, - -4.905984198491669 - ], - "translation_norm_m": 0.06764884469062708, - "rotation_rpy_deg_xyz": [ - -1.3607914184135292, - -0.9464656298160422, - -0.0632061013153367 - ], - "rotation_angle_deg": 1.6591937488334758, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.005376585287590441, - 0.046134652918175756, - -0.009440084240708274 - ], - "translation_xyz_cm": [ - 0.5376585287590441, - 4.613465291817576, - -0.9440084240708274 - ], - "translation_norm_m": 0.04739650894007855, - "rotation_rpy_deg_xyz": [ - -0.9755365487802141, - -0.429378725827992, - -0.08349268294444503 - ], - "rotation_angle_deg": 1.0693990905041029, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0020038123290264664, - -0.007882993625332124, - 0.032802462844172556 - ], - "translation_xyz_cm": [ - -0.20038123290264664, - -0.7882993625332124, - 3.2802462844172555 - ], - "translation_norm_m": 0.03379583437334114, - "rotation_rpy_deg_xyz": [ - 0.4160933353368461, - -1.2130878584899827, - 0.23275616468886484 - ], - "rotation_angle_deg": 1.3041982316300138, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.021913212378333213, - 0.004936150861672484, - 0.04697102480127482 - ], - "translation_xyz_cm": [ - -2.1913212378333213, - 0.49361508616724836, - 4.697102480127482 - ], - "translation_norm_m": 0.052065647340152225, - "rotation_rpy_deg_xyz": [ - -0.6620862793343182, - -1.2685208951991345, - 0.17210561720623507 - ], - "rotation_angle_deg": 1.4403407895998537, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - -0.001239460493835054, - 0.02453959834075481, - -0.039915954197930745 - ], - "translation_xyz_cm": [ - -0.1239460493835054, - 2.453959834075481, - -3.9915954197930743 - ], - "translation_norm_m": 0.04687228977309151, - "rotation_rpy_deg_xyz": [ - -0.03224414057122011, - -0.5351698402043175, - 0.0966033998309882 - ], - "rotation_angle_deg": 0.5447471790492916, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.010221516270926934, - 0.02469906101548891, - -0.08633609655418856 - ], - "translation_xyz_cm": [ - 1.0221516270926934, - 2.469906101548891, - -8.633609655418855 - ], - "translation_norm_m": 0.09037944776406767, - "rotation_rpy_deg_xyz": [ - 0.7342067412893403, - -0.48737349752310233, - 0.08890410666329722 - ], - "rotation_angle_deg": 0.8860294788460533, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.011346940213724954, - 0.0015972066668166196, - -0.0019876222978237046 - ], - "translation_xyz_cm": [ - -1.1346940213724954, - 0.15972066668166196, - -0.19876222978237046 - ], - "translation_norm_m": 0.011629908157383616, - "rotation_rpy_deg_xyz": [ - 0.24581690827081887, - -0.2505198194601695, - -0.053106914725930085 - ], - "rotation_angle_deg": 0.3548933527975264, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.013688585767871242, - 0.028420148005838586, - -0.04940886150355524 - ], - "translation_xyz_cm": [ - 1.3688585767871242, - 2.8420148005838586, - -4.9408861503555235 - ], - "translation_norm_m": 0.0586201141936421, - "rotation_rpy_deg_xyz": [ - 0.6906489034876203, - 0.10876126650003023, - -0.14672695535408956 - ], - "rotation_angle_deg": 0.7145247874224481, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.021458369435077174, - 0.023138963000122637, - 0.03005673299898205 - ], - "translation_xyz_cm": [ - 2.1458369435077174, - 2.3138963000122637, - 3.0056732998982048 - ], - "translation_norm_m": 0.0435807345751009, - "rotation_rpy_deg_xyz": [ - 1.040855552150943, - 0.26485229670634736, - -0.08547269644067847 - ], - "rotation_angle_deg": 1.0776092528007108, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0020023363821097817, - -0.0021184820384978487, - 0.016189480392791254 - ], - "translation_xyz_cm": [ - -0.20023363821097817, - -0.21184820384978487, - 1.6189480392791253 - ], - "translation_norm_m": 0.016449820440452564, - "rotation_rpy_deg_xyz": [ - 0.7105187461364953, - -0.1355706799282994, - 0.006152616837918827 - ], - "rotation_angle_deg": 0.7233700714610569, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.049579714631606375, - "improved_pairs": 32, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.04862337050743348, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - 0.0011901746480735614, - 0.7204968546603007 - ], - "rotation_rpy_deg_xyz": [ - -0.8851624923523462, - 1.2012008027315206, - -0.837607902463532 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.1195670451553767, - "median": 0.06251312158706117, - "p90": 0.19228486763403352, - "p95": 0.23719766724200894, - "max": 0.39188808810169584 - }, - "rotation_deg": { - "rms": 1.1451882592248208, - "median": 0.9340291802157791, - "p90": 1.6503530729493396, - "p95": 2.141856128764118, - "max": 2.8199380145655324 - }, - "normalized_pair_score": { - "rms": 3.3112438616237037, - "median": 2.4698695480427038, - "p90": 4.958886131329541, - "p95": 5.777632315480453, - "max": 8.332846273203428 - }, - "normalized_global_rms": 3.3112438616237037 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018153441311932694, - 0.021121019414630626, - 0.08658136322119231 - ], - "translation_xyz_cm": [ - -1.8153441311932694, - 2.1121019414630626, - 8.658136322119232 - ], - "translation_norm_m": 0.09095041148790378, - "rotation_rpy_deg_xyz": [ - 0.36775669868472677, - 0.12076502267561412, - 0.09474144234857859 - ], - "rotation_angle_deg": 0.3984113441028921, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.685676496509504, - "median": 0.7553149459813134, - "p90": 2.3646467024572515, - "p95": 3.99536236407491, - "max": 5.626801242035707 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018153441311932694, - 0.021121019414630626, - 0.08658136322119231 - ], - "translation_xyz_cm": [ - -1.8153441311932694, - 2.1121019414630626, - 8.658136322119232 - ], - "translation_norm_m": 0.09095041148790378, - "rotation_rpy_deg_xyz": [ - 0.36775669868472677, - 0.12076502267561412, - 0.09474144234857859 - ], - "rotation_angle_deg": 0.3984113441028921, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019755587487654713, - -0.022979501791488, - 0.17176487851191757 - ], - "translation_xyz_cm": [ - 1.9755587487654713, - -2.2979501791488, - 17.17648785119176 - ], - "translation_norm_m": 0.1744176431149704, - "rotation_rpy_deg_xyz": [ - -0.40492768443480737, - -0.2829585552934994, - -0.3559408930729585 - ], - "rotation_angle_deg": 0.6094559630782121, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030208540063907163, - 0.004617728856380232, - 0.15151901544380458 - ], - "translation_xyz_cm": [ - 3.0208540063907163, - 0.4617728856380232, - 15.151901544380458 - ], - "translation_norm_m": 0.15457002087611824, - "rotation_rpy_deg_xyz": [ - -0.11994988390304655, - -0.20941164512929622, - -0.3916133235775888 - ], - "rotation_angle_deg": 0.4601887117855082, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0090302630049022, - 0.000908185514410853, - 0.10349881126789923 - ], - "translation_xyz_cm": [ - -0.90302630049022, - 0.0908185514410853, - 10.349881126789922 - ], - "translation_norm_m": 0.10389597867451135, - "rotation_rpy_deg_xyz": [ - 0.4937527229643808, - 0.17601453300172093, - 0.20237018521008895 - ], - "rotation_angle_deg": 0.5616218671316345, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.01944684462797064, - -0.0018259721670446094, - -0.024365751869354045 - ], - "translation_xyz_cm": [ - -1.9446844627970639, - -0.18259721670446094, - -2.4365751869354044 - ], - "translation_norm_m": 0.03122825330527121, - "rotation_rpy_deg_xyz": [ - 0.4699330028932027, - -0.051833040581427986, - 0.05624957676671853 - ], - "rotation_angle_deg": 0.4761424014540832, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03115127211274782, - -0.017767250872227136, - 0.07491724656513447 - ], - "translation_xyz_cm": [ - 3.115127211274782, - -1.7767250872227136, - 7.491724656513448 - ], - "translation_norm_m": 0.08305823734404835, - "rotation_rpy_deg_xyz": [ - 0.3596558248224377, - 0.08448680672906754, - -0.3438595843093837 - ], - "rotation_angle_deg": 0.5048877850692589, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.043019918617981934, - 0.006956672517793083, - 0.06511513429944339 - ], - "translation_xyz_cm": [ - 4.301991861798193, - 0.6956672517793083, - 6.51151342994434 - ], - "translation_norm_m": 0.07835234141525163, - "rotation_rpy_deg_xyz": [ - 0.6657823006331337, - 0.4113556211536543, - -0.3599956047768376 - ], - "rotation_angle_deg": 0.8624344676795673, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.00041537631859209223, - -0.0033878190509888384, - 0.001970376697284615 - ], - "translation_xyz_cm": [ - 0.04153763185920922, - -0.33878190509888384, - 0.19703766972846148 - ], - "translation_norm_m": 0.003941096260876187, - "rotation_rpy_deg_xyz": [ - 0.865310882702772, - 0.34102519198834264, - 0.021676889502001022 - ], - "rotation_angle_deg": 0.9302779845982414, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005266087769098512, - 0.019618274914147, - 0.001272853140933541 - ], - "translation_xyz_cm": [ - 0.5266087769098512, - 1.9618274914147, - 0.1272853140933541 - ], - "translation_norm_m": 0.0203526053889246, - "rotation_rpy_deg_xyz": [ - 0.3326477311949064, - 0.2609389284515976, - -0.024862452399801577 - ], - "rotation_angle_deg": 0.42355548693943007, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.038557191834841464, - -0.0018960830850431876, - -0.0350091624253921 - ], - "translation_xyz_cm": [ - -3.8557191834841467, - -0.18960830850431876, - -3.50091624253921 - ], - "translation_norm_m": 0.052114236317743715, - "rotation_rpy_deg_xyz": [ - 0.681446955707971, - 0.953397606833245, - 0.5769908240910612 - ], - "rotation_angle_deg": 1.3037217533025505, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04996482521170259, - -0.024248461821506417, - -0.044100776852585385 - ], - "translation_xyz_cm": [ - -4.996482521170259, - -2.4248461821506417, - -4.410077685258538 - ], - "translation_norm_m": 0.07091791154670712, - "rotation_rpy_deg_xyz": [ - 0.7376283306668969, - 1.506052172646826, - 0.49403153077274203 - ], - "rotation_angle_deg": 1.7454879934242795, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.0329464904644694, - -0.019769328423886456, - -0.042981855431264565 - ], - "translation_xyz_cm": [ - -3.2946490464469402, - -1.9769328423886456, - -4.298185543126457 - ], - "translation_norm_m": 0.057651864467430584, - "rotation_rpy_deg_xyz": [ - 0.516711887078562, - 0.5283517049484306, - 0.598957845429434 - ], - "rotation_angle_deg": 0.9497559639518249, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04014651725761867, - -0.03993450235219481, - -0.05194223112135277 - ], - "translation_xyz_cm": [ - -4.014651725761867, - -3.9934502352194814, - -5.194223112135276 - ], - "translation_norm_m": 0.07684076196848749, - "rotation_rpy_deg_xyz": [ - 0.7071530615479656, - 1.0570064981168883, - 0.5187648301300798 - ], - "rotation_angle_deg": 1.3710040993430506, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012217032445279406, - -0.012954743542295782, - -0.010095437741771608 - ], - "translation_xyz_cm": [ - -1.2217032445279405, - -1.2954743542295781, - -1.009543774177161 - ], - "translation_norm_m": 0.020469468122392694, - "rotation_rpy_deg_xyz": [ - 0.38232156762635405, - 0.38097503257316945, - -0.08650208708965001 - ], - "rotation_angle_deg": 0.546821429490861, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009244883924005576, - -0.01147382939275525, - -0.19072311340614387 - ], - "translation_xyz_cm": [ - 0.9244883924005576, - -1.147382939275525, - -19.072311340614387 - ], - "translation_norm_m": 0.19129145989049068, - "rotation_rpy_deg_xyz": [ - -0.9473113461696623, - 0.1585622353676021, - 0.32933799395416863 - ], - "rotation_angle_deg": 1.0158073487843833, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0002752413348428018, - 0.010910179975213399, - -0.23542556291547143 - ], - "translation_xyz_cm": [ - 0.027524133484280178, - 1.0910179975213399, - -23.542556291547143 - ], - "translation_norm_m": 0.23567838988534895, - "rotation_rpy_deg_xyz": [ - -0.6000885575697806, - -0.14130577645152365, - 0.43105157025687485 - ], - "rotation_angle_deg": 0.7518238739451792, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.005170491052645221, - 0.0025059079374579185, - -0.02301419387205743 - ], - "translation_xyz_cm": [ - -0.5170491052645221, - 0.25059079374579185, - -2.3014193872057427 - ], - "translation_norm_m": 0.023720595943128083, - "rotation_rpy_deg_xyz": [ - 0.028544697009347614, - 0.022931899416461374, - -0.09958203996254122 - ], - "rotation_angle_deg": 0.10610556895236821, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0006679155540253584, - 0.028535770319337406, - -0.26452841488752404 - ], - "translation_xyz_cm": [ - 0.06679155540253584, - 2.8535770319337406, - -26.452841488752405 - ], - "translation_norm_m": 0.26606393701855074, - "rotation_rpy_deg_xyz": [ - -0.7705694256620943, - -0.0015222291981368946, - 0.06539269396686655 - ], - "rotation_angle_deg": 0.7733397430200151, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0021019505540922356, - 0.01508880418608849, - -0.16186090607813372 - ], - "translation_xyz_cm": [ - -0.21019505540922356, - 1.508880418608849, - -16.186090607813373 - ], - "translation_norm_m": 0.1625762686382376, - "rotation_rpy_deg_xyz": [ - -0.5392880314312288, - 0.7741642090030695, - 0.27625178210988044 - ], - "rotation_angle_deg": 0.9841156775596278, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.006924280737529709, - 0.02734774637810755, - 0.007486671789027399 - ], - "translation_xyz_cm": [ - 0.6924280737529709, - 2.734774637810755, - 0.7486671789027399 - ], - "translation_norm_m": 0.029187242935399677, - "rotation_rpy_deg_xyz": [ - 0.2231045610623083, - -0.751842780747167, - -0.2509447493412388 - ], - "rotation_angle_deg": 0.8229702997037107, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.013572557503988891, - -0.02798486144811404, - -0.024877614101272733 - ], - "translation_xyz_cm": [ - -1.3572557503988891, - -2.798486144811404, - -2.4877614101272734 - ], - "translation_norm_m": 0.039827910701429825, - "rotation_rpy_deg_xyz": [ - 0.05453328939701832, - -0.29104115757368776, - -0.47976011648743405 - ], - "rotation_angle_deg": 0.5636622996042631, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.005527443991338643, - 0.008704225690771394, - -0.0059682181828654216 - ], - "translation_xyz_cm": [ - 0.5527443991338643, - 0.8704225690771394, - -0.5968218182865421 - ], - "translation_norm_m": 0.01191368164051549, - "rotation_rpy_deg_xyz": [ - 0.4157609533287178, - -0.5350069000930723, - -0.4822495007487913 - ], - "rotation_angle_deg": 0.8305287281080137, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.019866086016123163, - 0.012543385766428106, - -0.19984924060906276 - ], - "translation_xyz_cm": [ - -1.9866086016123163, - 1.2543385766428106, - -19.984924060906277 - ], - "translation_norm_m": 0.2012255373259182, - "rotation_rpy_deg_xyz": [ - -0.765421871669922, - 1.0434184460967528, - -0.643255432308705 - ], - "rotation_angle_deg": 1.4420020882340745, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.02983225875578082, - 0.02604517630157721, - -0.22065390973897164 - ], - "translation_xyz_cm": [ - -2.983225875578082, - 2.604517630157721, - -22.065390973897163 - ], - "translation_norm_m": 0.22417953241575456, - "rotation_rpy_deg_xyz": [ - -0.3025912485034696, - 0.9026442563230053, - -0.41410123911232627 - ], - "rotation_angle_deg": 1.037221321688929, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011387122701143226, - 0.03034983563437821, - -0.03625313347904469 - ], - "translation_xyz_cm": [ - 1.1387122701143226, - 3.034983563437821, - -3.6253133479044695 - ], - "translation_norm_m": 0.048631972749355906, - "rotation_rpy_deg_xyz": [ - 0.34688768902559874, - -0.09034565160150707, - -0.011561961857459944 - ], - "rotation_angle_deg": 0.35863733068706655, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012332694520476695, - 0.044661364219101385, - -0.1372238269283147 - ], - "translation_xyz_cm": [ - 1.2332694520476695, - 4.4661364219101385, - -13.72238269283147 - ], - "translation_norm_m": 0.14483477305156622, - "rotation_rpy_deg_xyz": [ - -0.5449684117494943, - -0.22938406074940132, - 0.1627287661944651 - ], - "rotation_angle_deg": 0.6129703072911173, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00575746760167245, - 0.018570122791411015, - -0.08809291031163574 - ], - "translation_xyz_cm": [ - 0.575746760167245, - 1.8570122791411015, - -8.809291031163575 - ], - "translation_norm_m": 0.09021285241497626, - "rotation_rpy_deg_xyz": [ - -0.7546041054808138, - -0.11390576601308586, - 0.16175474880955595 - ], - "rotation_angle_deg": 0.7799507954533386, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.010367533614626057, - -0.024846728743325386, - -0.1652485854849684 - ], - "translation_xyz_cm": [ - -1.0367533614626057, - -2.4846728743325386, - -16.52485854849684 - ], - "translation_norm_m": 0.16742741916208856, - "rotation_rpy_deg_xyz": [ - -0.8713622744384394, - 2.3197442353572564, - -0.37371253893749423 - ], - "rotation_angle_deg": 2.503365115149131, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004185249521945045, - 0.02086745488271169, - -0.022733472940928853 - ], - "translation_xyz_cm": [ - 0.4185249521945045, - 2.086745488271169, - -2.2733472940928854 - ], - "translation_norm_m": 0.031141255254066004, - "rotation_rpy_deg_xyz": [ - 0.9952495505705931, - 0.12652375927629717, - 0.22010753440242178 - ], - "rotation_angle_deg": 1.0268845461135527, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.007720553798129304, - 0.03652148898263241, - 0.05975099760253545 - ], - "translation_xyz_cm": [ - 0.7720553798129304, - 3.652148898263241, - 5.975099760253546 - ], - "translation_norm_m": 0.07045287661236088, - "rotation_rpy_deg_xyz": [ - 1.1202241336016423, - 1.6307389913271197, - 0.15584121000419443 - ], - "rotation_angle_deg": 1.9832907880842687, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.013774767504927343, - 0.006167022235918473, - -0.025365240402310675 - ], - "translation_xyz_cm": [ - -1.3774767504927343, - 0.6167022235918473, - -2.5365240402310674 - ], - "translation_norm_m": 0.029515619657058345, - "rotation_rpy_deg_xyz": [ - -0.24731534989204415, - 2.3861835975357573, - 0.6867969869261337 - ], - "rotation_angle_deg": 2.4967425420608347, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.006197123201460153, - 0.0029546712682742005, - 0.39055496400373624 - ], - "translation_xyz_cm": [ - 0.6197123201460153, - 0.29546712682742005, - 39.05549640037363 - ], - "translation_norm_m": 0.39061530221720364, - "rotation_rpy_deg_xyz": [ - -1.3948843491939775, - 0.3893286233513809, - -0.06639447401636878 - ], - "rotation_angle_deg": 1.4495000243485099, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.01128109106996833, - 0.036957026689556804, - 0.049328643867533065 - ], - "translation_xyz_cm": [ - 1.128109106996833, - 3.6957026689556804, - 4.932864386753306 - ], - "translation_norm_m": 0.0626609921982683, - "rotation_rpy_deg_xyz": [ - 1.4110938319089001, - -0.33788182400217565, - 0.0578556435015686 - ], - "rotation_angle_deg": 1.4522991073751648, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.006812238168236506, - 0.018165032105800227, - 0.0038453879568253234 - ], - "translation_xyz_cm": [ - -0.6812238168236506, - 1.8165032105800227, - 0.38453879568253235 - ], - "translation_norm_m": 0.01977781557210069, - "rotation_rpy_deg_xyz": [ - -0.016321744294313222, - 2.0671331550541123, - 0.48406497603039983 - ], - "rotation_angle_deg": 2.1231778964853443, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.028579704125742622, - 0.025831437194793416, - 0.15318093978609296 - ], - "translation_xyz_cm": [ - 2.857970412574262, - 2.5831437194793416, - 15.318093978609296 - ], - "translation_norm_m": 0.1579508244651296, - "rotation_rpy_deg_xyz": [ - -0.20429480889084042, - -0.8632143756104382, - -0.3027004238498222 - ], - "rotation_angle_deg": 0.9377803758333167, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.003163480125035645, - 0.0122757804217688, - 0.39168299836032905 - ], - "translation_xyz_cm": [ - 0.3163480125035645, - 1.22757804217688, - 39.16829983603291 - ], - "translation_norm_m": 0.39188808810169584, - "rotation_rpy_deg_xyz": [ - -0.7235169524887703, - 0.3825413435627263, - -0.2491213000333698 - ], - "rotation_angle_deg": 0.8547921780529594, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01599242090898123, - 0.012714414369729199, - 0.05604970966377769 - ], - "translation_xyz_cm": [ - -1.599242090898123, - 1.27144143697292, - 5.604970966377769 - ], - "translation_norm_m": 0.059657219283913744, - "rotation_rpy_deg_xyz": [ - 0.7988186669937943, - 2.642807488846401, - 0.5929039178030466 - ], - "rotation_angle_deg": 2.8199380145655324, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03206827543520874, - 0.005334988068317781, - 0.18710218024424619 - ], - "translation_xyz_cm": [ - 3.2068275435208737, - 0.5334988068317781, - 18.71021802442462 - ], - "translation_norm_m": 0.18990540339660664, - "rotation_rpy_deg_xyz": [ - 0.12457885790498965, - -0.25555008576483623, - -0.22939850556071137 - ], - "rotation_angle_deg": 0.36513259864836417, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03446612066122978, - 0.012260916292791801, - 0.3211959217072903 - ], - "translation_xyz_cm": [ - 3.446612066122978, - 1.2260916292791801, - 32.11959217072903 - ], - "translation_norm_m": 0.3232724294819604, - "rotation_rpy_deg_xyz": [ - -0.06198254891006357, - -0.05092000522529114, - -0.24276103661470197 - ], - "rotation_angle_deg": 0.25569702162984853, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.027831288436696022, - 0.019518341406001616, - 0.0758250849045397 - ], - "translation_xyz_cm": [ - 2.7831288436696022, - 1.9518341406001616, - 7.58250849045397 - ], - "translation_norm_m": 0.08309626807545847, - "rotation_rpy_deg_xyz": [ - 0.8450979822523568, - -2.3254057103033983, - -0.7924281490093128 - ], - "rotation_angle_deg": 2.592733976214061, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.011453882413955618, - 0.026798752343866195, - 0.21492945391983456 - ], - "translation_xyz_cm": [ - -1.1453882413955618, - 2.6798752343866195, - 21.492945391983458 - ], - "translation_norm_m": 0.21689636859988892, - "rotation_rpy_deg_xyz": [ - 0.5901467460307781, - -0.6821841410280903, - -0.7361219419473681 - ], - "rotation_angle_deg": 1.16203968565877, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0025641412982122525, - -0.02046713625217289, - 0.1671166361245846 - ], - "translation_xyz_cm": [ - -0.25641412982122525, - -2.046713625217289, - 16.71166361245846 - ], - "translation_norm_m": 0.16838482282129535, - "rotation_rpy_deg_xyz": [ - -1.057566750156013, - 0.5442065849166081, - -0.026561282624048912 - ], - "rotation_angle_deg": 1.1895539073556036, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.004379722860630986, - -0.0075867930878916745, - -0.0547664193595464 - ], - "translation_xyz_cm": [ - 0.43797228606309857, - -0.7586793087891675, - -5.476641935954641 - ], - "translation_norm_m": 0.05546261886315966, - "rotation_rpy_deg_xyz": [ - -0.47598717112860006, - 0.42479083419118296, - 0.08662344038651049 - ], - "rotation_angle_deg": 0.644064621259908, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0006481450120832122, - 0.028511273537522586, - 0.06787380508111669 - ], - "translation_xyz_cm": [ - 0.06481450120832122, - 2.8511273537522586, - 6.787380508111669 - ], - "translation_norm_m": 0.07362177821051014, - "rotation_rpy_deg_xyz": [ - -0.8435578017060775, - 0.04576599427561032, - -0.7182810985070835 - ], - "rotation_angle_deg": 1.1086562408292513, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013413387997299964, - -0.042927124429565255, - -0.008983203308191993 - ], - "translation_xyz_cm": [ - 1.3413387997299964, - -4.2927124429565255, - -0.8983203308191993 - ], - "translation_norm_m": 0.04586234763979925, - "rotation_rpy_deg_xyz": [ - 0.09012127406973937, - 0.26969896534925786, - -0.6293731666540707 - ], - "rotation_angle_deg": 0.6908227841340113, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.019094056817653193, - -0.01656694291161953, - 0.007832510985380202 - ], - "translation_xyz_cm": [ - -1.9094056817653193, - -1.656694291161953, - 0.7832510985380202 - ], - "translation_norm_m": 0.02646497367330507, - "rotation_rpy_deg_xyz": [ - 0.45115053358144275, - -0.44816034256806586, - -0.7104773383207668 - ], - "rotation_angle_deg": 0.9521812657991725, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.011391380099142534, - 0.022303495500873627, - -0.06612513883427742 - ], - "translation_xyz_cm": [ - 1.1391380099142534, - 2.2303495500873627, - -6.612513883427742 - ], - "translation_norm_m": 0.07070886392789164, - "rotation_rpy_deg_xyz": [ - 0.43795125569335663, - 0.1819291526733248, - 0.14143323564912855 - ], - "rotation_angle_deg": 0.4946775972681358, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.009000559066967173, - 0.003394613262991175, - 0.020291406045706853 - ], - "translation_xyz_cm": [ - 0.9000559066967173, - 0.3394613262991175, - 2.0291406045706855 - ], - "translation_norm_m": 0.02245605980654196, - "rotation_rpy_deg_xyz": [ - 1.0894487577806318, - 0.6748940387221688, - 0.015538755291640501 - ], - "rotation_angle_deg": 1.2815650095873845, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.00511203585977249, - -0.016928438581272354, - -0.024466513126770173 - ], - "translation_xyz_cm": [ - 0.511203585977249, - -1.6928438581272354, - -2.4466513126770173 - ], - "translation_norm_m": 0.030187997747679912, - "rotation_rpy_deg_xyz": [ - -1.414124136383775, - -1.0732466987214098, - 0.1481951180124783 - ], - "rotation_angle_deg": 1.7803318741401473, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.01160575160343802, - 0.0028895228933366462, - 0.019463878130830184 - ], - "translation_xyz_cm": [ - 1.160575160343802, - 0.2889522893336646, - 1.9463878130830183 - ], - "translation_norm_m": 0.022844810454972705, - "rotation_rpy_deg_xyz": [ - -0.4521892124950199, - -0.6886503176649095, - -0.1345850263222568 - ], - "rotation_angle_deg": 0.8351982781118527, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0011787322256311406, - -0.02615033764328223, - 0.033597511415822984 - ], - "translation_xyz_cm": [ - -0.11787322256311406, - -2.615033764328223, - 3.3597511415822985 - ], - "translation_norm_m": 0.04259134116054296, - "rotation_rpy_deg_xyz": [ - 1.139692923334681, - -0.2714839564156239, - -0.20990731952313618 - ], - "rotation_angle_deg": 1.1897592509154429, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0025910867644708957, - 0.01669117979633228, - -0.062533921175468 - ], - "translation_xyz_cm": [ - -0.25910867644708957, - 1.6691179796332278, - -6.2533921175468 - ], - "translation_norm_m": 0.06477499912152954, - "rotation_rpy_deg_xyz": [ - 0.3901447106615934, - 1.3258645940638514, - 0.09207399984485293 - ], - "rotation_angle_deg": 1.3848353585859898, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008814188804059153, - 0.02496418180910398, - 0.05038773240549875 - ], - "translation_xyz_cm": [ - -0.8814188804059153, - 2.496418180910398, - 5.038773240549875 - ], - "translation_norm_m": 0.05691945075841604, - "rotation_rpy_deg_xyz": [ - 0.3515009887907271, - 0.9606102823499111, - -0.2791469442453926 - ], - "rotation_angle_deg": 1.0610787816970695, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0008137800552137087, - -0.03370415301068019, - -0.06283186388099352 - ], - "translation_xyz_cm": [ - -0.08137800552137087, - -3.3704153010680193, - -6.2831863880993515 - ], - "translation_norm_m": 0.07130550670814495, - "rotation_rpy_deg_xyz": [ - 0.018154774373464622, - 0.4069007920060598, - -0.09958968393834126 - ], - "rotation_angle_deg": 0.4193193920407655, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0017051977822781783, - 0.0344483148862027, - -0.05195989252592427 - ], - "translation_xyz_cm": [ - -0.17051977822781783, - 3.44483148862027, - -5.195989252592427 - ], - "translation_norm_m": 0.06236525097585403, - "rotation_rpy_deg_xyz": [ - -0.12174531732739179, - 1.0156339306222437, - 0.21000885966103314 - ], - "rotation_angle_deg": 1.0444565955991336, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.02019470911937793, - 0.01166720330115767, - -0.07367476452241342 - ], - "translation_xyz_cm": [ - -2.019470911937793, - 1.166720330115767, - -7.367476452241342 - ], - "translation_norm_m": 0.07727820415045822, - "rotation_rpy_deg_xyz": [ - 0.5901606288343687, - -0.025159062449558803, - 0.3597192339206432 - ], - "rotation_angle_deg": 0.6916737244228991, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.02665501086982469, - 0.01670690961961452, - -0.07901666689679816 - ], - "translation_xyz_cm": [ - -2.665501086982469, - 1.6706909619614518, - -7.901666689679816 - ], - "translation_norm_m": 0.08504848076825358, - "rotation_rpy_deg_xyz": [ - -0.11459300631275088, - 0.40355832169762124, - 0.06980628495203652 - ], - "rotation_angle_deg": 0.4253469877575524, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03235808204533219, - 0.023941495322853168, - -0.05393911943862522 - ], - "translation_xyz_cm": [ - -3.2358082045332193, - 2.394149532285317, - -5.393911943862522 - ], - "translation_norm_m": 0.0673028177549865, - "rotation_rpy_deg_xyz": [ - 0.237350657490103, - 0.5127010740315826, - 0.31320301792246524 - ], - "rotation_angle_deg": 0.6454668673320086, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.01127981708705561, - -0.011165253483586879, - -0.057485430585281556 - ], - "translation_xyz_cm": [ - -1.127981708705561, - -1.1165253483586879, - -5.748543058528155 - ], - "translation_norm_m": 0.05963616258986996, - "rotation_rpy_deg_xyz": [ - 1.0278188662197756, - 0.392459004412426, - 0.4837458213855797 - ], - "rotation_angle_deg": 1.2004285476486143, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.015121416197757975, - -0.019301034107270132, - -0.013847662331022637 - ], - "translation_xyz_cm": [ - 1.5121416197757975, - -1.9301034107270132, - -1.3847662331022637 - ], - "translation_norm_m": 0.028159277289551404, - "rotation_rpy_deg_xyz": [ - -0.09332347394458201, - -0.3663218811743383, - -0.23594161910752753 - ], - "rotation_angle_deg": 0.4457689824631002, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008382547466916412, - 0.0005192020772648576, - -0.040787100520534664 - ], - "translation_xyz_cm": [ - -0.8382547466916412, - 0.051920207726485756, - -4.0787100520534665 - ], - "translation_norm_m": 0.041642817408339965, - "rotation_rpy_deg_xyz": [ - 0.6827118410042375, - 0.4041929897871398, - 0.2646541040823606 - ], - "rotation_angle_deg": 0.8356025066568541, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0008867600648831964, - 0.0028726372006624423, - 0.04652779170623406 - ], - "translation_xyz_cm": [ - -0.08867600648831964, - 0.28726372006624423, - 4.652779170623407 - ], - "translation_norm_m": 0.04662481945228319, - "rotation_rpy_deg_xyz": [ - 1.006797052551254, - -0.46726940676515744, - -0.2906509595265635 - ], - "rotation_angle_deg": 1.1463264109168394, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.015205449609196897, - 0.011000503157776453, - 0.010075345267319777 - ], - "translation_xyz_cm": [ - -1.5205449609196897, - 1.1000503157776453, - 1.0075345267319777 - ], - "translation_norm_m": 0.02130092368414522, - "rotation_rpy_deg_xyz": [ - 0.9890234965102256, - 0.4382734748880865, - 0.4126142050819344 - ], - "rotation_angle_deg": 1.1564472312703247, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.009513480441316169, - -0.004097062675660901, - -0.02645881102775291 - ], - "translation_xyz_cm": [ - -0.9513480441316169, - -0.4097062675660901, - -2.645881102775291 - ], - "translation_norm_m": 0.02841409709418791, - "rotation_rpy_deg_xyz": [ - -0.4477816703269087, - 0.4526670668474313, - -0.30018242317460586 - ], - "rotation_angle_deg": 0.7031795328069609, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.00685453397150626, - 0.018166732704428146, - 0.13269744304196737 - ], - "translation_xyz_cm": [ - 0.685453397150626, - 1.8166732704428146, - 13.269744304196736 - ], - "translation_norm_m": 0.1341104999729583, - "rotation_rpy_deg_xyz": [ - 1.5347787802288344, - -0.28941883954209785, - -0.5034894695450236 - ], - "rotation_angle_deg": 1.6397825262299008, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0012776314471834027, - 0.006306385307832008, - 0.0756132837217985 - ], - "translation_xyz_cm": [ - 0.12776314471834027, - 0.6306385307832008, - 7.56132837217985 - ], - "translation_norm_m": 0.07588657004344622, - "rotation_rpy_deg_xyz": [ - 1.0386285115859302, - 0.16745866496739809, - 0.1762143192763737 - ], - "rotation_angle_deg": 1.0664457410048298, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.006556567178324535, - 0.01331356083580193, - 0.023094060010192347 - ], - "translation_xyz_cm": [ - 0.6556567178324535, - 1.331356083580193, - 2.3094060010192345 - ], - "translation_norm_m": 0.02745132206373396, - "rotation_rpy_deg_xyz": [ - 0.670150901372797, - 0.8513077899066331, - -0.5141993704013783 - ], - "rotation_angle_deg": 1.2013875370339242, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007533581306170767, - 0.04137516431465438, - 0.0784157117568398 - ], - "translation_xyz_cm": [ - -0.7533581306170767, - 4.137516431465437, - 7.841571175683979 - ], - "translation_norm_m": 0.08898136276599228, - "rotation_rpy_deg_xyz": [ - -1.1688133295527496, - -0.35251252397953964, - 0.6259840053523189 - ], - "rotation_angle_deg": 1.3703010573009662, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021549784397615568, - 0.02448585014512794, - 0.05900676345898827 - ], - "translation_xyz_cm": [ - 2.154978439761557, - 2.448585014512794, - 5.900676345898827 - ], - "translation_norm_m": 0.0674221640027845, - "rotation_rpy_deg_xyz": [ - -0.3869205680248251, - -0.1958843487534032, - 0.5063026614844708 - ], - "rotation_angle_deg": 0.6661452356130614, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006035834969039255, - -0.031766532912323564, - 0.007933598383222024 - ], - "translation_xyz_cm": [ - -0.6035834969039255, - -3.1766532912323564, - 0.7933598383222024 - ], - "translation_norm_m": 0.03329393188479662, - "rotation_rpy_deg_xyz": [ - 0.24038792280061297, - -0.6173637163793759, - -0.1205534166566289 - ], - "rotation_angle_deg": 0.6731600560721773, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.02839552577951232, - 0.034123752070645, - -0.05250798971676322 - ], - "translation_xyz_cm": [ - -2.839552577951232, - 3.4123752070644997, - -5.250798971676322 - ], - "translation_norm_m": 0.0687591835595036, - "rotation_rpy_deg_xyz": [ - -1.1648603829492068, - -0.9171469725710338, - -0.05926606312326031 - ], - "rotation_angle_deg": 1.4841316195281777, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.005261279712500677, - 0.04367648586617001, - -0.011761540880755067 - ], - "translation_xyz_cm": [ - 0.5261279712500677, - 4.367648586617001, - -1.1761540880755068 - ], - "translation_norm_m": 0.045537350886064865, - "rotation_rpy_deg_xyz": [ - -0.7769289214754866, - -0.44403084524097314, - -0.07934510674026654 - ], - "rotation_angle_deg": 0.8986390698273515, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.001098233495104406, - -0.008076333251056389, - 0.03002982407491106 - ], - "translation_xyz_cm": [ - -0.1098233495104406, - -0.8076333251056389, - 3.002982407491106 - ], - "translation_norm_m": 0.03111629170646779, - "rotation_rpy_deg_xyz": [ - 0.43699894642993387, - -1.1503922801465287, - 0.23468594310994353 - ], - "rotation_angle_deg": 1.2535942724272653, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.020465073962058433, - 0.0037558022626433263, - 0.042392910903593824 - ], - "translation_xyz_cm": [ - -2.0465073962058433, - 0.37558022626433263, - 4.239291090359383 - ], - "translation_norm_m": 0.047223767297714006, - "rotation_rpy_deg_xyz": [ - -0.5659722348980563, - -1.1671423008571533, - 0.1746896983051757 - ], - "rotation_angle_deg": 1.3080656759007587, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - -0.00018063738644902294, - 0.022694989319138492, - -0.03950479523019963 - ], - "translation_xyz_cm": [ - -0.018063738644902294, - 2.269498931913849, - -3.9504795230199634 - ], - "translation_norm_m": 0.04556011431330256, - "rotation_rpy_deg_xyz": [ - 0.11616398250050587, - -0.4463157623511784, - 0.1012302472866361 - ], - "rotation_angle_deg": 0.47226144369778367, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.010878295776799662, - 0.02236506347646272, - -0.08370418806810181 - ], - "translation_xyz_cm": [ - 1.0878295776799662, - 2.236506347646272, - -8.370418806810182 - ], - "translation_norm_m": 0.0873208135753092, - "rotation_rpy_deg_xyz": [ - 0.9154601342460379, - -0.4278965435305235, - 0.0945327995691027 - ], - "rotation_angle_deg": 1.0152543221067527, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0103315330593996, - 0.001198581026871759, - -0.004589347859730961 - ], - "translation_xyz_cm": [ - -1.03315330593996, - 0.1198581026871759, - -0.45893478597309606 - ], - "translation_norm_m": 0.011368345772937282, - "rotation_rpy_deg_xyz": [ - 0.28045613495164456, - -0.17338156205729244, - -0.05076715386677972 - ], - "rotation_angle_deg": 0.3335430426165025, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.014853984596626013, - 0.027307074084125027, - -0.04760422050336528 - ], - "translation_xyz_cm": [ - 1.4853984596626013, - 2.7307074084125027, - -4.760422050336528 - ], - "translation_norm_m": 0.05685489392449623, - "rotation_rpy_deg_xyz": [ - 0.773939022579733, - 0.20872853628050833, - -0.142070968277248 - ], - "rotation_angle_deg": 0.8143297515746188, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022080698710210456, - 0.02290594749828534, - 0.030968514896769217 - ], - "translation_xyz_cm": [ - 2.2080698710210456, - 2.290594749828534, - 3.0968514896769217 - ], - "translation_norm_m": 0.04439919595259255, - "rotation_rpy_deg_xyz": [ - 1.0545527398659862, - 0.31679586703118207, - -0.08338732928222344 - ], - "rotation_angle_deg": 1.1044807438596433, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.001437396294971638, - -0.0021940196824391522, - 0.015620710858023976 - ], - "translation_xyz_cm": [ - -0.1437396294971638, - -0.21940196824391522, - 1.5620710858023976 - ], - "translation_norm_m": 0.015839395133202427, - "rotation_rpy_deg_xyz": [ - 0.7195744447587586, - -0.09251348526773107, - 0.007582984693431476 - ], - "rotation_angle_deg": 0.7255427798232988, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.015008244398968529, - "improved_pairs": 36, - "worsened_pairs": 44, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.022882341914364612, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.000_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.0, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977596922478565, - -0.00132483596826191, - 0.7204966196317207 - ], - "rotation_rpy_deg_xyz": [ - -0.6851396936080634, - 1.2041171781580922, - -0.833409656117373 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.1180779565326178, - "median": 0.06055008597165533, - "p90": 0.19374336571378895, - "p95": 0.2388891824817664, - "max": 0.3839352965464938 - }, - "rotation_deg": { - "rms": 1.153258101553409, - "median": 0.9437837234743934, - "p90": 1.6666516552082253, - "p95": 1.9627159612642795, - "max": 2.7068958727340853 - }, - "normalized_pair_score": { - "rms": 3.3010571825949637, - "median": 2.5560037383546166, - "p90": 4.976302690702337, - "p95": 5.668096875120823, - "max": 7.970287166489358 - }, - "normalized_global_rms": 3.3010571825949637 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01882096787859594, - 0.021284757620385952, - 0.08798425394581517 - ], - "translation_xyz_cm": [ - -1.882096787859594, - 2.1284757620385952, - 8.798425394581518 - ], - "translation_norm_m": 0.09245809148607498, - "rotation_rpy_deg_xyz": [ - 0.37370221526972836, - 0.07518921111784563, - 0.09394674455536739 - ], - "rotation_angle_deg": 0.39253869750368725, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.652705907802981, - "median": 0.7642140295928858, - "p90": 2.3730818708821753, - "p95": 3.9393965271141544, - "max": 5.432408856778532 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01882096787859594, - 0.021284757620385952, - 0.08798425394581517 - ], - "translation_xyz_cm": [ - -1.882096787859594, - 2.1284757620385952, - 8.798425394581518 - ], - "translation_norm_m": 0.09245809148607498, - "rotation_rpy_deg_xyz": [ - 0.37370221526972836, - 0.07518921111784563, - 0.09394674455536739 - ], - "rotation_angle_deg": 0.39253869750368725, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.018394733323809587, - -0.022858053744537754, - 0.17344264045012608 - ], - "translation_xyz_cm": [ - 1.8394733323809587, - -2.2858053744537754, - 17.344264045012608 - ], - "translation_norm_m": 0.17590681158316174, - "rotation_rpy_deg_xyz": [ - -0.38292906216720823, - -0.3712821007532503, - -0.35608216773439627 - ], - "rotation_angle_deg": 0.6419982357065115, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.02816847994738747, - 0.004285194660127889, - 0.153723372816956 - ], - "translation_xyz_cm": [ - 2.816847994738747, - 0.4285194660127889, - 15.3723372816956 - ], - "translation_norm_m": 0.15634161795901438, - "rotation_rpy_deg_xyz": [ - -0.06725454286462511, - -0.34181466011410055, - -0.3921051967743457 - ], - "rotation_angle_deg": 0.5246558459591194, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.011726754969292548, - -0.0007729059188179566, - 0.10545023968387617 - ], - "translation_xyz_cm": [ - -1.1726754969292548, - -0.07729059188179566, - 10.545023968387616 - ], - "translation_norm_m": 0.10610309710397761, - "rotation_rpy_deg_xyz": [ - 0.6311154482242342, - -0.011041230711297981, - 0.20085442010612178 - ], - "rotation_angle_deg": 0.6624161338765464, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.022252175022702825, - -0.004398783796974337, - -0.022287727741862814 - ], - "translation_xyz_cm": [ - -2.2252175022702825, - -0.4398783796974337, - -2.2287727741862815 - ], - "translation_norm_m": 0.03180017924523264, - "rotation_rpy_deg_xyz": [ - 0.6702470740195088, - -0.24896063698111762, - 0.055792397160096464 - ], - "rotation_angle_deg": 0.7172775405222436, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03052244219764877, - -0.01768560110327111, - 0.07580969332656506 - ], - "translation_xyz_cm": [ - 3.052244219764877, - -1.768560110327111, - 7.580969332656506 - ], - "translation_norm_m": 0.08361524721222008, - "rotation_rpy_deg_xyz": [ - 0.36552563101499747, - 0.03921689434718262, - -0.3446432771617934 - ], - "rotation_angle_deg": 0.5039957871943219, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04170583115543913, - 0.006768115461295743, - 0.06664719142029421 - ], - "translation_xyz_cm": [ - 4.170583115543913, - 0.6768115461295743, - 6.664719142029421 - ], - "translation_norm_m": 0.07891154455133144, - "rotation_rpy_deg_xyz": [ - 0.6914637837770954, - 0.3161738592108938, - -0.3618882732203321 - ], - "rotation_angle_deg": 0.8428694520226452, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.002030072904134733, - -0.0053868883608665374, - 0.003727545651424441 - ], - "translation_xyz_cm": [ - -0.20300729041347332, - -0.5386888360866537, - 0.3727545651424441 - ], - "translation_norm_m": 0.006858160015047379, - "rotation_rpy_deg_xyz": [ - 1.019948516780945, - 0.14912778822607753, - 0.019136439431262267 - ], - "rotation_angle_deg": 1.0309456236372767, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.0045817440123239244, - 0.01951867734070395, - 0.0019823963357523513 - ], - "translation_xyz_cm": [ - 0.45817440123239245, - 1.951867734070395, - 0.19823963357523514 - ], - "translation_norm_m": 0.02014698584297364, - "rotation_rpy_deg_xyz": [ - 0.34063125187105475, - 0.2078275176708663, - -0.025734748812367862 - ], - "rotation_angle_deg": 0.3998948251209165, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.04022145183728117, - -0.002771460058568598, - -0.03417791682283264 - ], - "translation_xyz_cm": [ - -4.022145183728117, - -0.2771460058568598, - -3.417791682283264 - ], - "translation_norm_m": 0.05285429194590952, - "rotation_rpy_deg_xyz": [ - 0.7410905673049347, - 0.8137802482816153, - 0.5745965891623778 - ], - "rotation_angle_deg": 1.2391720129083263, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.05201286088518098, - -0.025782500276810616, - -0.042770181865889476 - ], - "translation_xyz_cm": [ - -5.201286088518097, - -2.5782500276810616, - -4.277018186588948 - ], - "translation_norm_m": 0.0721066118662234, - "rotation_rpy_deg_xyz": [ - 0.8492253421691339, - 1.3295161217665445, - 0.4915107227298986 - ], - "rotation_angle_deg": 1.6494381950886874, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.034098289878127144, - -0.020245657803818068, - -0.042666221212014306 - ], - "translation_xyz_cm": [ - -3.4098289878127144, - -2.0245657803818067, - -4.266622121201431 - ], - "translation_norm_m": 0.058249347335696616, - "rotation_rpy_deg_xyz": [ - 0.5435066775667898, - 0.43120973491184783, - 0.5972903978059422 - ], - "rotation_angle_deg": 0.9141379682662846, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04184470711725474, - -0.04094354158106989, - -0.05097765454463596 - ], - "translation_xyz_cm": [ - -4.184470711725474, - -4.094354158106989, - -5.0977654544635955 - ], - "translation_norm_m": 0.07762779382284332, - "rotation_rpy_deg_xyz": [ - 0.7742027945069876, - 0.910454211372459, - 0.5162697490686667 - ], - "rotation_angle_deg": 1.2994143501370359, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.0130028817789715, - -0.013155357420938152, - -0.009297280136169376 - ], - "translation_xyz_cm": [ - -1.30028817789715, - -1.3155357420938152, - -0.9297280136169376 - ], - "translation_norm_m": 0.02070212021414597, - "rotation_rpy_deg_xyz": [ - 0.39339207345105154, - 0.3181956714591942, - -0.08755496678840353 - ], - "rotation_angle_deg": 0.5136754979128891, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.0076141583092901866, - -0.013575934450477431, - -0.19192489570248783 - ], - "translation_xyz_cm": [ - 0.7614158309290187, - -1.3575934450477432, - -19.19248957024878 - ], - "translation_norm_m": 0.1925550492544234, - "rotation_rpy_deg_xyz": [ - -0.79566782236105, - -0.03259514677274349, - 0.33280949186778447 - ], - "rotation_angle_deg": 0.8629944604908176, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0011572034934529407, - 0.009356294085023996, - -0.23720607157617032 - ], - "translation_xyz_cm": [ - -0.11572034934529407, - 0.9356294085023996, - -23.72060715761703 - ], - "translation_norm_m": 0.23739334394950914, - "rotation_rpy_deg_xyz": [ - -0.507065602877347, - -0.30741051213640735, - 0.43233322024863685 - ], - "rotation_angle_deg": 0.7330418017657251, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.007217663044384537, - 8.637435728464649e-05, - -0.02099743914822534 - ], - "translation_xyz_cm": [ - -0.7217663044384537, - 0.008637435728464649, - -2.0997439148225343 - ], - "translation_norm_m": 0.022203481058953273, - "rotation_rpy_deg_xyz": [ - 0.21631084497630634, - -0.1738188613856523, - -0.09875650408155112 - ], - "rotation_angle_deg": 0.29443397208987626, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.0007006698908977038, - 0.025321344271391544, - -0.2661071888367579 - ], - "translation_xyz_cm": [ - -0.07006698908977038, - 2.5321344271391544, - -26.610718883675787 - ], - "translation_norm_m": 0.26731011459465626, - "rotation_rpy_deg_xyz": [ - -0.4831868125217153, - -0.17847726269077394, - 0.07093723362791891 - ], - "rotation_angle_deg": 0.5198545252712878, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.002944127870693203, - 0.014431062655887006, - -0.1609519160015675 - ], - "translation_xyz_cm": [ - -0.2944127870693203, - 1.4431062655887006, - -16.09519160015675 - ], - "translation_norm_m": 0.16162438777261545, - "rotation_rpy_deg_xyz": [ - -0.5203966955627465, - 0.6921754400544798, - 0.27628303227526463 - ], - "rotation_angle_deg": 0.9099362932019166, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.004960353468977052, - 0.026118236679836038, - 0.011418352521271671 - ], - "translation_xyz_cm": [ - 0.49603534689770523, - 2.6118236679836038, - 1.141835252127167 - ], - "translation_norm_m": 0.02893347832703763, - "rotation_rpy_deg_xyz": [ - 0.3053895662733075, - -0.9106361555318365, - -0.25212619448951284 - ], - "rotation_angle_deg": 0.9924018370600829, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014947764769104088, - -0.028127943900211262, - -0.023023384081222814 - ], - "translation_xyz_cm": [ - -1.4947764769104088, - -2.8127943900211263, - -2.3023384081222815 - ], - "translation_norm_m": 0.03930258406514011, - "rotation_rpy_deg_xyz": [ - 0.08072827616265714, - -0.38711429641486134, - -0.48064030061873547 - ], - "rotation_angle_deg": 0.6221949310567197, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0037701350672108003, - 0.007993097035847996, - -0.003666178518106942 - ], - "translation_xyz_cm": [ - 0.37701350672108, - 0.7993097035847996, - -0.3666178518106942 - ], - "translation_norm_m": 0.009567882920276743, - "rotation_rpy_deg_xyz": [ - 0.4694607512131962, - -0.668468109251501, - -0.48398268439845554 - ], - "rotation_angle_deg": 0.9480637737247628, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.021617767079496364, - 0.009868727176114422, - -0.20305236677225041 - ], - "translation_xyz_cm": [ - -2.1617767079496364, - 0.9868727176114422, - -20.305236677225043 - ], - "translation_norm_m": 0.20443821384807792, - "rotation_rpy_deg_xyz": [ - -0.5444744788788933, - 0.8474248773076675, - -0.6390632481518526 - ], - "rotation_angle_deg": 1.1907228628406146, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.03130164051901251, - 0.02285425867906099, - -0.2263305462257335 - ], - "translation_xyz_cm": [ - -3.130164051901251, - 2.285425867906099, - -22.63305462257335 - ], - "translation_norm_m": 0.22962496814107522, - "rotation_rpy_deg_xyz": [ - -0.014271887404346761, - 0.726075161648849, - -0.409980324390622 - ], - "rotation_angle_deg": 0.8339042462222893, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.010832936679442962, - 0.030018552888471106, - -0.034838972791124266 - ], - "translation_xyz_cm": [ - 1.0832936679442962, - 3.0018552888471106, - -3.4838972791124267 - ], - "translation_norm_m": 0.04724637615478519, - "rotation_rpy_deg_xyz": [ - 0.35294532231745074, - -0.13635663391098196, - -0.012346427783892042 - ], - "rotation_angle_deg": 0.3785571773496139, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011244288774709954, - 0.043930217755107304, - -0.1342593605531093 - ], - "translation_xyz_cm": [ - 1.1244288774709954, - 4.39302177551073, - -13.425936055310931 - ], - "translation_norm_m": 0.1417105287485373, - "rotation_rpy_deg_xyz": [ - -0.5177442649230676, - -0.32725697053355873, - 0.16286678049882997 - ], - "rotation_angle_deg": 0.6334028929811337, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005072079491212411, - 0.01826973643286922, - -0.08606664331548027 - ], - "translation_xyz_cm": [ - 0.5072079491212411, - 1.8269736432869221, - -8.606664331548027 - ], - "translation_norm_m": 0.0881304507607092, - "rotation_rpy_deg_xyz": [ - -0.7459556961523895, - -0.16924391499937344, - 0.1619026373058312 - ], - "rotation_angle_deg": 0.7816318371510789, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.011492998504874397, - -0.02578487470402946, - -0.16217098088419493 - ], - "translation_xyz_cm": [ - -1.1492998504874397, - -2.578487470402946, - -16.217098088419494 - ], - "translation_norm_m": 0.164609768297867, - "rotation_rpy_deg_xyz": [ - -0.8294795772563534, - 2.200203920392824, - -0.3726971492612737 - ], - "rotation_angle_deg": 2.378205494805034, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.003300292541735139, - 0.020533046922086462, - -0.020100500213016834 - ], - "translation_xyz_cm": [ - 0.3300292541735139, - 2.053304692208646, - -2.010050021301683 - ], - "translation_norm_m": 0.028922794740120234, - "rotation_rpy_deg_xyz": [ - 1.008553116518345, - 0.057669373070390675, - 0.21823875762763076 - ], - "rotation_angle_deg": 1.033397522976997, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.006148055661199692, - 0.03575237163384348, - 0.06128335338458221 - ], - "translation_xyz_cm": [ - 0.6148055661199692, - 3.5752371633843483, - 6.128335338458221 - ], - "translation_norm_m": 0.07121572907663903, - "rotation_rpy_deg_xyz": [ - 1.171440223981679, - 1.4999019871553707, - 0.15250655270949182 - ], - "rotation_angle_deg": 1.9080039594445015, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.01590229912605734, - 0.002372463127224833, - -0.020591947294802085 - ], - "translation_xyz_cm": [ - -1.590229912605734, - 0.2372463127224833, - -2.0591947294802084 - ], - "translation_norm_m": 0.026125466353283576, - "rotation_rpy_deg_xyz": [ - 0.045151844695473245, - 2.211658010784186, - 0.6908533568371075 - ], - "rotation_angle_deg": 2.3172148326149102, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.006174669105579511, - -0.0032258960446474028, - 0.38387208675597895 - ], - "translation_xyz_cm": [ - 0.6174669105579511, - -0.3225896044647403, - 38.3872086755979 - ], - "translation_norm_m": 0.3839352965464938, - "rotation_rpy_deg_xyz": [ - -0.9951050807668181, - 0.38410232983147213, - -0.057965137957610435 - ], - "rotation_angle_deg": 1.0680534563643485, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010360719786721484, - 0.03673571072498616, - 0.050253159891402235 - ], - "translation_xyz_cm": [ - 1.0360719786721484, - 3.673571072498616, - 5.025315989140224 - ], - "translation_norm_m": 0.06310496839425295, - "rotation_rpy_deg_xyz": [ - 1.4253683360262437, - -0.40914819099173866, - 0.055413159556736695 - ], - "rotation_angle_deg": 1.4841505898364817, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.009343893750010546, - 0.015212519204377273, - 0.008799417813135028 - ], - "translation_xyz_cm": [ - -0.9343893750010546, - 1.5212519204377273, - 0.8799417813135029 - ], - "translation_norm_m": 0.019903739467877674, - "rotation_rpy_deg_xyz": [ - 0.20911800326086355, - 1.8716259118444796, - 0.4857897660585349 - ], - "rotation_angle_deg": 1.944058125930037, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.026222304530870932, - 0.02113044052622115, - 0.14986866431101914 - ], - "translation_xyz_cm": [ - 2.6222304530870932, - 2.113044052622115, - 14.986866431101914 - ], - "translation_norm_m": 0.15360573333736877, - "rotation_rpy_deg_xyz": [ - 0.12931191995180255, - -1.0090431059995626, - -0.2975968916139902 - ], - "rotation_angle_deg": 1.059609828033413, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0018828146625236228, - 0.006380594433086806, - 0.38293872968115905 - ], - "translation_xyz_cm": [ - 0.18828146625236228, - 0.6380594433086806, - 38.293872968115906 - ], - "translation_norm_m": 0.3829965112976785, - "rotation_rpy_deg_xyz": [ - -0.3388705374274636, - 0.3087166373084205, - -0.2413742352316947 - ], - "rotation_angle_deg": 0.5176479660548732, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01844595089596246, - 0.010685486041067171, - 0.06034515615903577 - ], - "translation_xyz_cm": [ - -1.844595089596246, - 1.0685486041067171, - 6.034515615903577 - ], - "translation_norm_m": 0.06399977022027901, - "rotation_rpy_deg_xyz": [ - 0.9515019358369886, - 2.451350414037199, - 0.5905609078988068 - ], - "rotation_angle_deg": 2.6905383097515068, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.029053083129910284, - 0.0016923416631686727, - 0.1835151737820457 - ], - "translation_xyz_cm": [ - 2.9053083129910284, - 0.16923416631686727, - 18.35151737820457 - ], - "translation_norm_m": 0.1858084084962594, - "rotation_rpy_deg_xyz": [ - 0.3962708121241813, - -0.4393795940806803, - -0.22704849638178132 - ], - "rotation_angle_deg": 0.6332020292391531, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03215274768181842, - 0.007217222953731728, - 0.3112267987211355 - ], - "translation_xyz_cm": [ - 3.2152747681818417, - 0.7217222953731728, - 31.12267987211355 - ], - "translation_norm_m": 0.31296646423037205, - "rotation_rpy_deg_xyz": [ - 0.2829803777069502, - -0.1857756055547745, - -0.23762620334782975 - ], - "rotation_angle_deg": 0.41332604281691854, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.025990022848991767, - 0.019607673693891936, - 0.07623500982963949 - ], - "translation_xyz_cm": [ - 2.5990022848991767, - 1.9607673693891936, - 7.623500982963948 - ], - "translation_norm_m": 0.08289583149412572, - "rotation_rpy_deg_xyz": [ - 0.8823656894053971, - -2.4386295620847727, - -0.7949090607135243 - ], - "rotation_angle_deg": 2.7068958727340853, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.01444470642317075, - 0.026099703452772793, - 0.21254866459319152 - ], - "translation_xyz_cm": [ - -1.444470642317075, - 2.6099703452772793, - 21.254866459319153 - ], - "translation_norm_m": 0.21463172851263929, - "rotation_rpy_deg_xyz": [ - 0.6930834130564998, - -0.8541445517469114, - -0.7382440664024124 - ], - "rotation_angle_deg": 1.3218466206482065, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0038133674435658627, - -0.020400712682963507, - 0.1681645684188412 - ], - "translation_xyz_cm": [ - -0.38133674435658627, - -2.0400712682963507, - 16.81645684188412 - ], - "translation_norm_m": 0.16944041112062846, - "rotation_rpy_deg_xyz": [ - -1.0368843626070443, - 0.45851508125225926, - -0.025735242260079123 - ], - "rotation_angle_deg": 1.1339348567579688, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0025815483982778997, - -0.008433051048456708, - -0.04926668424223369 - ], - "translation_xyz_cm": [ - 0.25815483982779, - -0.8433051048456708, - -4.926668424223369 - ], - "translation_norm_m": 0.050049844338843706, - "rotation_rpy_deg_xyz": [ - -0.41535326157800284, - 0.2842239374515606, - 0.08706345257923295 - ], - "rotation_angle_deg": 0.5109409046201941, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0007633525339021396, - 0.028107317539846077, - 0.06708314483279584 - ], - "translation_xyz_cm": [ - -0.07633525339021396, - 2.8107317539846077, - 6.708314483279584 - ], - "translation_norm_m": 0.07273755788473117, - "rotation_rpy_deg_xyz": [ - -0.8076600796781315, - -0.06568521397375732, - -0.7174487796089547 - ], - "rotation_angle_deg": 1.0825976871068739, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.011340106745952205, - -0.04406170006118315, - 0.0009720065978988789 - ], - "translation_xyz_cm": [ - 1.1340106745952205, - -4.406170006118315, - 0.0972006597898879 - ], - "translation_norm_m": 0.04550797985098456, - "rotation_rpy_deg_xyz": [ - 0.16618023227845335, - 0.11561020477897023, - -0.6302325691759848 - ], - "rotation_angle_deg": 0.6621069280106455, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.016668615314081592, - -0.01974880053174921, - 0.016896646927115434 - ], - "translation_xyz_cm": [ - -1.6668615314081592, - -1.974880053174921, - 1.6896646927115435 - ], - "translation_norm_m": 0.030876439825719103, - "rotation_rpy_deg_xyz": [ - 0.6822474399437979, - -0.24786714734738685, - -0.7008964329824983 - ], - "rotation_angle_deg": 1.0080077038429647, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.009389610336893117, - 0.021409689621288308, - -0.05519344925003732 - ], - "translation_xyz_cm": [ - 0.9389610336893117, - 2.140968962128831, - -5.5193449250037325 - ], - "translation_norm_m": 0.05994044070637983, - "rotation_rpy_deg_xyz": [ - 0.49524718984038224, - 0.044686944648024474, - 0.1396376040112447 - ], - "rotation_angle_deg": 0.5164409852425259, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.011599568137974192, - 0.0011764298720562394, - 0.020678601671543506 - ], - "translation_xyz_cm": [ - 1.1599568137974192, - 0.11764298720562394, - 2.0678601671543504 - ], - "translation_norm_m": 0.02373896660180755, - "rotation_rpy_deg_xyz": [ - 1.2654385247640811, - 0.8761092603169175, - 0.026128580035704726 - ], - "rotation_angle_deg": 1.539171196759925, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.003538479741359346, - -0.017269012675188766, - -0.018325589594633318 - ], - "translation_xyz_cm": [ - 0.3538479741359346, - -1.7269012675188766, - -1.8325589594633318 - ], - "translation_norm_m": 0.025427679242250437, - "rotation_rpy_deg_xyz": [ - -1.3823326546522354, - -1.178609724075905, - 0.149991107338424 - ], - "rotation_angle_deg": 1.8215727962840516, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.008789366586602121, - 0.0010148092420138588, - 0.02411283189411606 - ], - "translation_xyz_cm": [ - 0.8789366586602121, - 0.10148092420138588, - 2.411283189411606 - ], - "translation_norm_m": 0.02568484893366623, - "rotation_rpy_deg_xyz": [ - -0.3004748179118876, - -0.8798553493276822, - -0.13276356060077396 - ], - "rotation_angle_deg": 0.9395036732240241, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.001894731655779136, - -0.031414481914231907, - 0.03757023532309656 - ], - "translation_xyz_cm": [ - -0.1894731655779136, - -3.1414481914231907, - 3.7570235323096557 - ], - "translation_norm_m": 0.04901002207936523, - "rotation_rpy_deg_xyz": [ - 1.5340040577357132, - -0.31561898248283865, - -0.20325821962220852 - ], - "rotation_angle_deg": 1.5787246750339063, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.00011308268782372899, - 0.013889723918118602, - -0.06028000368633726 - ], - "translation_xyz_cm": [ - -0.011308268782372899, - 1.3889723918118602, - -6.028000368633727 - ], - "translation_norm_m": 0.061859648096644355, - "rotation_rpy_deg_xyz": [ - 0.6098268018612546, - 1.5276715772781513, - 0.10121235713046559 - ], - "rotation_angle_deg": 1.6474964929767857, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010733754684244756, - 0.024353027950688944, - 0.0550656813722034 - ], - "translation_xyz_cm": [ - -1.0733754684244756, - 2.4353027950688944, - 5.50656813722034 - ], - "translation_norm_m": 0.061159731236930824, - "rotation_rpy_deg_xyz": [ - 0.40782914465110987, - 0.8243359728091403, - -0.280734671532745 - ], - "rotation_angle_deg": 0.962449499043257, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.0033839502521479936, - -0.036448266639484084, - -0.051409560945271104 - ], - "translation_xyz_cm": [ - -0.33839502521479936, - -3.6448266639484084, - -5.140956094527111 - ], - "translation_norm_m": 0.06310998508094805, - "rotation_rpy_deg_xyz": [ - 0.22248405218279593, - 0.20982215568609894, - -0.0984144698280438 - ], - "rotation_angle_deg": 0.32138762240691315, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0013429260948516486, - 0.029568655550219702, - -0.038334016451580195 - ], - "translation_xyz_cm": [ - -0.13429260948516486, - 2.9568655550219702, - -3.8334016451580197 - ], - "translation_norm_m": 0.048431453197832014, - "rotation_rpy_deg_xyz": [ - 0.275743752624987, - 1.0503303911170894, - 0.2188746786188731 - ], - "rotation_angle_deg": 1.1072600095404788, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018405018518082628, - 0.010273253252960024, - -0.06868632042759873 - ], - "translation_xyz_cm": [ - -1.8405018518082628, - 1.0273253252960024, - -6.868632042759873 - ], - "translation_norm_m": 0.07184772127864032, - "rotation_rpy_deg_xyz": [ - 0.6789237828519255, - 0.14389417278492503, - 0.36577283411534905 - ], - "rotation_angle_deg": 0.7840964587457153, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.028831938684080738, - 0.015021492085230959, - -0.07484730348621352 - ], - "translation_xyz_cm": [ - -2.883193868408074, - 1.5021492085230959, - -7.484730348621352 - ], - "translation_norm_m": 0.08160297023948698, - "rotation_rpy_deg_xyz": [ - 0.009217272606026722, - 0.22151770565500356, - 0.07007836030016623 - ], - "rotation_angle_deg": 0.2325156447923944, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.034593599762417826, - 0.021019437337610802, - -0.05154500324218436 - ], - "translation_xyz_cm": [ - -3.4593599762417826, - 2.1019437337610802, - -5.154500324218436 - ], - "translation_norm_m": 0.06553946330073888, - "rotation_rpy_deg_xyz": [ - 0.4677401476761134, - 0.31789209868878593, - 0.31417177432010746 - ], - "rotation_angle_deg": 0.6463152882274137, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009963566369942445, - -0.01567115530432739, - -0.055492947893682164 - ], - "translation_xyz_cm": [ - -0.9963566369942445, - -1.5671155304327389, - -5.549294789368217 - ], - "translation_norm_m": 0.05851773260569415, - "rotation_rpy_deg_xyz": [ - 1.3948574307180266, - 0.5050132316399956, - 0.4953779171711557 - ], - "rotation_angle_deg": 1.5620333482854818, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.017333815083258708, - -0.022884972018956118, - -0.016302520259658615 - ], - "translation_xyz_cm": [ - 1.7333815083258708, - -2.288497201895612, - -1.6302520259658615 - ], - "translation_norm_m": 0.03301447041019424, - "rotation_rpy_deg_xyz": [ - 0.1981433290581154, - -0.18572097932088813, - -0.22718084403597455 - ], - "rotation_angle_deg": 0.35386177303160643, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00968519474591012, - 3.607080202583379e-05, - -0.038550204344735425 - ], - "translation_xyz_cm": [ - -0.968519474591012, - 0.0036070802025833792, - -3.8550204344735426 - ], - "translation_norm_m": 0.03974823962630071, - "rotation_rpy_deg_xyz": [ - 0.7130099642609402, - 0.3012264830349814, - 0.26262488101327375 - ], - "rotation_angle_deg": 0.8167654146281557, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0030234517268674654, - -0.0010124270320668316, - 0.04608044965558979 - ], - "translation_xyz_cm": [ - -0.30234517268674654, - -0.10124270320668316, - 4.608044965558979 - ], - "translation_norm_m": 0.04619062793794108, - "rotation_rpy_deg_xyz": [ - 1.3149875721747073, - -0.6326254145220574, - -0.28979549199430477 - ], - "rotation_angle_deg": 1.4863239628915075, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.01665595711025203, - 0.006046011777961269, - 0.02003037006103682 - ], - "translation_xyz_cm": [ - -1.6655957110252029, - 0.6046011777961269, - 2.003037006103682 - ], - "translation_norm_m": 0.02674305312524884, - "rotation_rpy_deg_xyz": [ - 1.355863752381085, - 0.3308109186636553, - 0.4166464141650748 - ], - "rotation_angle_deg": 1.4553766682208606, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.009810453761035731, - -0.009274714619428526, - -0.017073448786747658 - ], - "translation_xyz_cm": [ - -0.9810453761035731, - -0.9274714619428526, - -1.7073448786747658 - ], - "translation_norm_m": 0.021766212066938895, - "rotation_rpy_deg_xyz": [ - -0.04832404412082062, - 0.4414044301335105, - -0.29190275303687124 - ], - "rotation_angle_deg": 0.5312920024985289, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.004501778902933129, - 0.015975890896723133, - 0.12368332897077007 - ], - "translation_xyz_cm": [ - 0.4501778902933129, - 1.5975890896723133, - 12.368332897077007 - ], - "translation_norm_m": 0.12479207093612409, - "rotation_rpy_deg_xyz": [ - 1.7404813283373313, - -0.4864264504927196, - -0.5075033981729478 - ], - "rotation_angle_deg": 1.8750752267102564, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.001141970064522102, - 0.0023971057509262206, - 0.0841177815953054 - ], - "translation_xyz_cm": [ - -0.1141970064522102, - 0.23971057509262206, - 8.41177815953054 - ], - "translation_norm_m": 0.08415967794689384, - "rotation_rpy_deg_xyz": [ - 1.324442340496146, - -0.010340444578361115, - 0.1761126927473306 - ], - "rotation_angle_deg": 1.3361552412212279, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.004958595727996951, - 0.008368066858944978, - 0.03345147959936351 - ], - "translation_xyz_cm": [ - 0.49585957279969506, - 0.8368066858944978, - 3.3451479599363507 - ], - "translation_norm_m": 0.0348369588502802, - "rotation_rpy_deg_xyz": [ - 1.0335812257578902, - 0.7388242615987891, - -0.509782147896546 - ], - "rotation_angle_deg": 1.3714219534387388, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005961032160809232, - 0.04112601926926063, - 0.06788451064116376 - ], - "translation_xyz_cm": [ - -0.5961032160809232, - 4.112601926926063, - 6.7884510641163756 - ], - "translation_norm_m": 0.07959390774643543, - "rotation_rpy_deg_xyz": [ - -1.144673231907246, - -0.2542932532784725, - 0.625853773495571 - ], - "rotation_angle_deg": 1.3279455686791812, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.024509214015600023, - 0.02289409813223786, - 0.0416749142921959 - ], - "translation_xyz_cm": [ - 2.4509214015600023, - 2.289409813223786, - 4.16749142921959 - ], - "translation_norm_m": 0.05349429672603329, - "rotation_rpy_deg_xyz": [ - -0.24448313967947885, - -0.0014434751982334772, - 0.5108863595053182 - ], - "rotation_angle_deg": 0.5663703900836046, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0040943183935842065, - -0.03238338774617677, - 0.0025161981731230895 - ], - "translation_xyz_cm": [ - -0.40943183935842065, - -3.2383387746176773, - 0.251619817312309 - ], - "translation_norm_m": 0.032738028319886675, - "rotation_rpy_deg_xyz": [ - 0.2964451607152044, - -0.475566513419304, - -0.11676776000400525 - ], - "rotation_angle_deg": 0.5721800635349581, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.02744491627620138, - 0.029289951777405676, - -0.05943007235542641 - ], - "translation_xyz_cm": [ - -2.744491627620138, - 2.9289951777405676, - -5.943007235542641 - ], - "translation_norm_m": 0.07171511838309738, - "rotation_rpy_deg_xyz": [ - -0.7729918657740713, - -0.8585511344294318, - -0.05122372003100243 - ], - "rotation_angle_deg": 1.156647048995873, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0050333859996762875, - 0.03877217832174784, - -0.016430289972944268 - ], - "translation_xyz_cm": [ - 0.5033385999676288, - 3.877217832174784, - -1.6430289972944268 - ], - "translation_norm_m": 0.042409565136065516, - "rotation_rpy_deg_xyz": [ - -0.37971829139552743, - -0.4733782648311828, - -0.07111052971373058 - ], - "rotation_angle_deg": 0.6111889175435533, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.000704115304898334, - -0.00847457689407538, - 0.024481041496089206 - ], - "translation_xyz_cm": [ - 0.0704115304898334, - -0.8474576894075381, - 2.4481041496089206 - ], - "translation_norm_m": 0.0259159337981372, - "rotation_rpy_deg_xyz": [ - 0.47882820896866984, - -1.02499576925092, - 0.23828735075359367 - ], - "rotation_angle_deg": 1.1570250028760185, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.017592473824521004, - 0.0013941788897216534, - 0.03322297085124327 - ], - "translation_xyz_cm": [ - -1.7592473824521004, - 0.13941788897216534, - 3.322297085124327 - ], - "translation_norm_m": 0.03761920602864396, - "rotation_rpy_deg_xyz": [ - -0.3737192093142323, - -0.9643951926174226, - 0.1798444667107038 - ], - "rotation_angle_deg": 1.0492534007279788, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0019394348342010037, - 0.0190050721714754, - -0.03870185351653328 - ], - "translation_xyz_cm": [ - 0.19394348342010037, - 1.9005072171475401, - -3.8701853516533284 - ], - "translation_norm_m": 0.043160023648444644, - "rotation_rpy_deg_xyz": [ - 0.41300986335041734, - -0.2686360085301555, - 0.11072023546903689 - ], - "rotation_angle_deg": 0.5051885162172532, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012200703028880655, - 0.017686418940258797, - -0.07846430252346175 - ], - "translation_xyz_cm": [ - 1.2200703028880655, - 1.7686418940258797, - -7.846430252346175 - ], - "translation_norm_m": 0.0813530167837838, - "rotation_rpy_deg_xyz": [ - 1.2779890339611222, - -0.3089872461765054, - 0.10605639730791236 - ], - "rotation_angle_deg": 1.3193572438954824, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.008310986801504772, - 0.00039247918743723353, - -0.009797800938272143 - ], - "translation_xyz_cm": [ - -0.8310986801504772, - 0.03924791874372335, - -0.9797800938272143 - ], - "translation_norm_m": 0.012853927211298669, - "rotation_rpy_deg_xyz": [ - 0.34975283620860437, - -0.019101149455670253, - -0.04634892345858574 - ], - "rotation_angle_deg": 0.3533195592513651, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01719433478271748, - 0.025082788397152278, - -0.044005589038165135 - ], - "translation_xyz_cm": [ - 1.719433478271748, - 2.508278839715228, - -4.400558903816513 - ], - "translation_norm_m": 0.05349096455470181, - "rotation_rpy_deg_xyz": [ - 0.94055402317328, - 0.4086577956159647, - -0.13284003114124884 - ], - "rotation_angle_deg": 1.0344933373454621, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.023327798349242368, - 0.022444073144984644, - 0.032790521317219865 - ], - "translation_xyz_cm": [ - 2.332779834924237, - 2.2444073144984644, - 3.2790521317219863 - ], - "translation_norm_m": 0.04607755292347225, - "rotation_rpy_deg_xyz": [ - 1.0819569340987127, - 0.4206905969242049, - -0.07945020701052373 - ], - "rotation_angle_deg": 1.1638511133805693, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00030874346669440556, - -0.0023478137163334134, - 0.014481666298035767 - ], - "translation_xyz_cm": [ - -0.030874346669440556, - -0.23478137163334134, - 1.4481666298035767 - ], - "translation_norm_m": 0.014673997769609164, - "rotation_rpy_deg_xyz": [ - 0.7376939331200643, - -0.006393570927133602, - 0.010239421399100548 - ], - "rotation_angle_deg": 0.7377932659911178, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.004821565370228598, - "improved_pairs": 39, - "worsened_pairs": 41, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.0017696484744595953, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152137045299, - 0.0024476764333135033, - 0.7182275658581914 - ], - "rotation_rpy_deg_xyz": [ - -0.9866396137764585, - 1.299726385041302, - -0.8397351699715397 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.12047176074785593, - "median": 0.06368306492625511, - "p90": 0.1923231756436391, - "p95": 0.23692226297770783, - "max": 0.39463528149327637 - }, - "rotation_deg": { - "rms": 1.1833438511380916, - "median": 0.9771317484916682, - "p90": 1.700835023140188, - "p95": 2.3397931469964144, - "max": 2.987831659342916 - }, - "normalized_pair_score": { - "rms": 3.3773641697603143, - "median": 2.3902378381788187, - "p90": 5.200463375781415, - "p95": 6.088659562233003, - "max": 8.560254380684112 - }, - "normalized_global_rms": 3.3773641697603143 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.017898524645807545, - 0.02074311495099701, - 0.08495359103816826 - ], - "translation_xyz_cm": [ - -1.7898524645807545, - 2.074311495099701, - 8.495359103816826 - ], - "translation_norm_m": 0.08926223519858327, - "rotation_rpy_deg_xyz": [ - 0.38757014329627265, - 0.14651480273926523, - 0.09576444128346716 - ], - "rotation_angle_deg": 0.4251505609368216, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7058242505297496, - "median": 0.6958135424032661, - "p90": 2.316636492319242, - "p95": 3.9421963521214107, - "max": 5.747677749152345 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.017898524645807545, - 0.02074311495099701, - 0.08495359103816826 - ], - "translation_xyz_cm": [ - -1.7898524645807545, - 2.074311495099701, - 8.495359103816826 - ], - "translation_norm_m": 0.08926223519858327, - "rotation_rpy_deg_xyz": [ - 0.38757014329627265, - 0.14651480273926523, - 0.09576444128346716 - ], - "rotation_angle_deg": 0.4251505609368216, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.020427024047155906, - -0.023672152211678954, - 0.1686650060322995 - ], - "translation_xyz_cm": [ - 2.0427024047155906, - -2.3672152211678954, - 16.86650060322995 - ], - "translation_norm_m": 0.171538678908378, - "rotation_rpy_deg_xyz": [ - -0.3717842888245399, - -0.22780361292697068, - -0.35469016462413355 - ], - "rotation_angle_deg": 0.5625359233596857, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.03144007541795346, - 0.003834341892601456, - 0.14789119957649835 - ], - "translation_xyz_cm": [ - 3.144007541795346, - 0.3834341892601456, - 14.789119957649834 - ], - "translation_norm_m": 0.15124479307470928, - "rotation_rpy_deg_xyz": [ - -0.0801234050057476, - -0.11688005229362072, - -0.3893937456005621 - ], - "rotation_angle_deg": 0.4144535697991246, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.00682115962060259, - 0.0004967033012022171, - 0.09960889569738365 - ], - "translation_xyz_cm": [ - -0.682115962060259, - 0.049670330120221706, - 9.960889569738365 - ], - "translation_norm_m": 0.0998434125758501, - "rotation_rpy_deg_xyz": [ - 0.5185809619814122, - 0.3381682679521643, - 0.20699398337317457 - ], - "rotation_angle_deg": 0.6523003509885226, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.016721513568244806, - -0.001833916345348463, - -0.028711398935298976 - ], - "translation_xyz_cm": [ - -1.6721513568244806, - -0.1833916345348463, - -2.8711398935298975 - ], - "translation_norm_m": 0.03327636840156417, - "rotation_rpy_deg_xyz": [ - 0.4682897169168139, - 0.146828068993997, - 0.06108616730688471 - ], - "rotation_angle_deg": 0.4944813556416433, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03144107611224989, - -0.01808205042354233, - 0.07319744060060443 - ], - "translation_xyz_cm": [ - 3.144107611224989, - -1.8082050423542328, - 7.319744060060443 - ], - "translation_norm_m": 0.08169067954849459, - "rotation_rpy_deg_xyz": [ - 0.37935373956580126, - 0.11004569208157994, - -0.34284711458005707 - ], - "rotation_angle_deg": 0.5232712011063069, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.043770730486258014, - 0.006450487158958906, - 0.06287423539103101 - ], - "translation_xyz_cm": [ - 4.377073048625801, - 0.6450487158958906, - 6.287423539103101 - ], - "translation_norm_m": 0.07688078503693434, - "rotation_rpy_deg_xyz": [ - 0.7005396570847636, - 0.4717610737149654, - -0.3575295653208253 - ], - "rotation_angle_deg": 0.9182586172956042, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.002636792819765532, - -0.0035222157767016427, - -0.0011589176804301035 - ], - "translation_xyz_cm": [ - 0.2636792819765532, - -0.35222157767016427, - -0.11589176804301035 - ], - "translation_norm_m": 0.004549919839077004, - "rotation_rpy_deg_xyz": [ - 0.8839429872775009, - 0.5142114946468392, - 0.02755745054031845 - ], - "rotation_angle_deg": 1.0228901202522231, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005652661707667029, - 0.019336080017313934, - 0.0007986167165121689 - ], - "translation_xyz_cm": [ - 0.5652661707667029, - 1.9336080017313932, - 0.07986167165121688 - ], - "translation_norm_m": 0.02016120937536201, - "rotation_rpy_deg_xyz": [ - 0.3552110741750715, - 0.29147512524436575, - -0.023687715002692636 - ], - "rotation_angle_deg": 0.4601481207022191, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03729810932127545, - -0.002271185241962903, - -0.03594653562535009 - ], - "translation_xyz_cm": [ - -3.7298109321275446, - -0.2271185241962903, - -3.5946535625350093 - ], - "translation_norm_m": 0.05185036802964554, - "rotation_rpy_deg_xyz": [ - 0.7214663980066243, - 1.0529971485876692, - 0.5807109375051274 - ], - "rotation_angle_deg": 1.399576197056534, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.048200710375079114, - -0.024480471888624455, - -0.04562674942619402 - ], - "translation_xyz_cm": [ - -4.820071037507912, - -2.4480471888624455, - -4.5626749426194015 - ], - "translation_norm_m": 0.07074179986226452, - "rotation_rpy_deg_xyz": [ - 0.7701765396156991, - 1.6500816144396686, - 0.49899024229860556 - ], - "rotation_angle_deg": 1.8851532149611185, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.032132622061350855, - -0.020094150788489362, - -0.04350506546355044 - ], - "translation_xyz_cm": [ - -3.2132622061350853, - -2.009415078848936, - -4.350506546355044 - ], - "translation_norm_m": 0.05769723578678591, - "rotation_rpy_deg_xyz": [ - 0.5518931204249674, - 0.5902981922978084, - 0.6013155383903054 - ], - "rotation_angle_deg": 1.0055797356177028, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03880667643012681, - -0.04025687412670065, - -0.05304861606195478 - ], - "translation_xyz_cm": [ - -3.8806676430126807, - -4.025687412670065, - -5.3048616061954785 - ], - "translation_norm_m": 0.07707612935334951, - "rotation_rpy_deg_xyz": [ - 0.7469443379917401, - 1.163775563426033, - 0.522732560977845 - ], - "rotation_angle_deg": 1.4756644394839153, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01173163728816775, - -0.01323831674690093, - -0.01055669240310362 - ], - "translation_xyz_cm": [ - -1.1731637288167749, - -1.3238316746900929, - -1.055669240310362 - ], - "translation_norm_m": 0.02059922567103315, - "rotation_rpy_deg_xyz": [ - 0.40817749177100776, - 0.41788694189364806, - -0.08508000223925213 - ], - "rotation_angle_deg": 0.590533194152952, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011115154870535215, - -0.011248340119687214, - -0.19039437667152126 - ], - "translation_xyz_cm": [ - 1.1115154870535215, - -1.1248340119687215, - -19.039437667152125 - ], - "translation_norm_m": 0.19104996857204992, - "rotation_rpy_deg_xyz": [ - -0.9275789367000229, - 0.3299810343718153, - 0.329764057817921 - ], - "rotation_angle_deg": 1.0391299728583523, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.001784935196470716, - 0.010953072238412716, - -0.23505587655344515 - ], - "translation_xyz_cm": [ - 0.1784935196470716, - 1.0953072238412715, - -23.505587655344513 - ], - "translation_norm_m": 0.2353177020273314, - "rotation_rpy_deg_xyz": [ - -0.5635816104913435, - -0.011737860382403808, - 0.43264920116496214 - ], - "rotation_angle_deg": 0.7105602554327345, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0029502010044548665, - 0.002724170088368061, - -0.02443003911597523 - ], - "translation_xyz_cm": [ - -0.29502010044548665, - 0.2724170088368061, - -2.443003911597523 - ], - "translation_norm_m": 0.02475785935506391, - "rotation_rpy_deg_xyz": [ - 0.03299230867556963, - 0.2151638802762747, - -0.09624152962139132 - ], - "rotation_angle_deg": 0.23803010610125472, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0029994255662747354, - 0.029447899686903867, - -0.26576560292733764 - ], - "translation_xyz_cm": [ - 0.29994255662747354, - 2.9447899686903867, - -26.576560292733763 - ], - "translation_norm_m": 0.26740892103486164, - "rotation_rpy_deg_xyz": [ - -0.8258280232929786, - 0.23067372307541859, - 0.0647445723852963 - ], - "rotation_angle_deg": 0.8600048914680807, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0013331238469849183, - 0.015025464534259014, - -0.16521271830836848 - ], - "translation_xyz_cm": [ - -0.13331238469849183, - 1.5025464534259014, - -16.52127183083685 - ], - "translation_norm_m": 0.16589992192433964, - "rotation_rpy_deg_xyz": [ - -0.5077372831623289, - 0.8246011358322918, - 0.277303304413979 - ], - "rotation_angle_deg": 1.0083061928869121, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.008538495795664347, - 0.02709285630043179, - 0.0037612226759671658 - ], - "translation_xyz_cm": [ - 0.8538495795664347, - 2.709285630043179, - 0.3761222675967166 - ], - "translation_norm_m": 0.028654416221354673, - "rotation_rpy_deg_xyz": [ - 0.261300059766227, - -0.6313461566833758, - -0.2476317486943234 - ], - "rotation_angle_deg": 0.7262800796899319, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.01287212081375344, - -0.028602743275562607, - -0.02414139045476675 - ], - "translation_xyz_cm": [ - -1.287212081375344, - -2.8602743275562608, - -2.414139045476675 - ], - "translation_norm_m": 0.03958048951467263, - "rotation_rpy_deg_xyz": [ - 0.08945328370122405, - -0.2299265385057546, - -0.47792237562815815 - ], - "rotation_angle_deg": 0.5376857585311664, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.00671585095158489, - 0.008206735395164644, - -0.006506494823543634 - ], - "translation_xyz_cm": [ - 0.671585095158489, - 0.8206735395164644, - -0.6506494823543634 - ], - "translation_norm_m": 0.012441367880540786, - "rotation_rpy_deg_xyz": [ - 0.4556069622392824, - -0.44147180105404443, - -0.47913926198257045 - ], - "rotation_angle_deg": 0.793954715378492, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01764320058763702, - 0.01301203993409672, - -0.20259941714163368 - ], - "translation_xyz_cm": [ - -1.764320058763702, - 1.301203993409672, - -20.259941714163368 - ], - "translation_norm_m": 0.2037820392879407, - "rotation_rpy_deg_xyz": [ - -0.7778954072014697, - 1.2518728193054498, - -0.6429302374307618 - ], - "rotation_angle_deg": 1.6045845872542295, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.027448917856254938, - 0.026948202825124667, - -0.22339510574301635 - ], - "translation_xyz_cm": [ - -2.744891785625494, - 2.6948202825124667, - -22.339510574301634 - ], - "translation_norm_m": 0.2266826459985787, - "rotation_rpy_deg_xyz": [ - -0.35847405956804046, - 1.1350599051791805, - -0.41286569572848414 - ], - "rotation_angle_deg": 1.2587217315872998, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011833750444922408, - 0.030275866008487085, - -0.03776661664431386 - ], - "translation_xyz_cm": [ - 1.1833750444922408, - 3.0275866008487085, - -3.776661664431386 - ], - "translation_norm_m": 0.04982953988263517, - "rotation_rpy_deg_xyz": [ - 0.36686016013672146, - -0.06432356508892474, - -0.010538616826096194 - ], - "rotation_angle_deg": 0.37259979283451633, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013281509648040757, - 0.04454097195005002, - -0.1406364761122435 - ], - "translation_xyz_cm": [ - 1.3281509648040757, - 4.454097195005002, - -14.06364761122435 - ], - "translation_norm_m": 0.14811790943047967, - "rotation_rpy_deg_xyz": [ - -0.5096642011787106, - -0.16683813309184284, - 0.1639455423172831 - ], - "rotation_angle_deg": 0.5605595540836725, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006270200681587124, - 0.018408516744998993, - -0.09002427996679464 - ], - "translation_xyz_cm": [ - 0.6270200681587124, - 1.8408516744998993, - -9.002427996679465 - ], - "translation_norm_m": 0.09210081372538523, - "rotation_rpy_deg_xyz": [ - -0.7312687905567562, - -0.0819120175458842, - 0.16237189366654978 - ], - "rotation_angle_deg": 0.7534308527263126, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.009424125814937456, - -0.024954336263876886, - -0.17117210315842024 - ], - "translation_xyz_cm": [ - -0.9424125814937456, - -2.4954336263876886, - -17.117210315842023 - ], - "translation_norm_m": 0.17323804993540903, - "rotation_rpy_deg_xyz": [ - -0.8324913831944685, - 2.4004416685529035, - -0.37274583529454947 - ], - "rotation_angle_deg": 2.565341476980701, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004773084154823415, - 0.02066027076092769, - -0.025165610787061386 - ], - "translation_xyz_cm": [ - 0.4773084154823415, - 2.066027076092769, - -2.5165610787061388 - ], - "translation_norm_m": 0.0329080094589407, - "rotation_rpy_deg_xyz": [ - 1.0230306504501827, - 0.16757536652678423, - 0.22210831832996575 - ], - "rotation_angle_deg": 1.0598767183052837, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.008831050361105541, - 0.036265661110473246, - 0.05495497608791211 - ], - "translation_xyz_cm": [ - 0.8831050361105541, - 3.6265661110473246, - 5.4954976087912115 - ], - "translation_norm_m": 0.06643218363928033, - "rotation_rpy_deg_xyz": [ - 1.160109899487225, - 1.721746685514635, - 0.16001057068787078 - ], - "rotation_angle_deg": 2.080910311845424, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.010974115033442366, - 0.00701232577539157, - -0.03322831197106862 - ], - "translation_xyz_cm": [ - -1.0974115033442366, - 0.701232577539157, - -3.322831197106862 - ], - "translation_norm_m": 0.03568927892230535, - "rotation_rpy_deg_xyz": [ - -0.30620497598759777, - 2.6195964552353694, - 0.6881967880787009 - ], - "rotation_angle_deg": 2.7274890640514764, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0092876710217219, - 0.005981419873394067, - 0.39265748514715476 - ], - "translation_xyz_cm": [ - 0.9287671021721899, - 0.5981419873394067, - 39.265748514715476 - ], - "translation_norm_m": 0.39281285475248595, - "rotation_rpy_deg_xyz": [ - -1.592164356462627, - 0.5918146249108915, - -0.0726707216298253 - ], - "rotation_angle_deg": 1.699792599003074, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011911927507552988, - 0.03674489680753901, - 0.04594487535928214 - ], - "translation_xyz_cm": [ - 1.1911927507552988, - 3.6744896807539007, - 4.594487535928214 - ], - "translation_norm_m": 0.06002510333287115, - "rotation_rpy_deg_xyz": [ - 1.4395944460285226, - -0.29515757888418725, - 0.060240339969950096 - ], - "rotation_angle_deg": 1.4709252278811802, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0041799898461796214, - 0.01840108330730561, - -0.0023599344257560426 - ], - "translation_xyz_cm": [ - -0.41799898461796214, - 1.840108330730561, - -0.23599344257560426 - ], - "translation_norm_m": 0.019016873362633364, - "rotation_rpy_deg_xyz": [ - -0.03120123863058355, - 2.277554652811363, - 0.48708996779759417 - ], - "rotation_angle_deg": 2.3293900703531563, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03224779396215727, - 0.026985565357020125, - 0.15141428648557775 - ], - "translation_xyz_cm": [ - 3.2247793962157267, - 2.6985565357020125, - 15.141428648557776 - ], - "translation_norm_m": 0.15714460571397404, - "rotation_rpy_deg_xyz": [ - -0.29830304933434826, - -0.6234555360656571, - -0.3018873924414752 - ], - "rotation_angle_deg": 0.7548479567394346, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0067936831022175695, - 0.014531557306910692, - 0.39430912379936134 - ], - "translation_xyz_cm": [ - 0.6793683102217569, - 1.4531557306910692, - 39.43091237993613 - ], - "translation_norm_m": 0.39463528149327637, - "rotation_rpy_deg_xyz": [ - -0.878964753145839, - 0.6117770923386688, - -0.2519752499186799 - ], - "rotation_angle_deg": 1.0990758645559213, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01382084528155536, - 0.012455412996137671, - 0.053833075840244014 - ], - "translation_xyz_cm": [ - -1.382084528155536, - 1.2455412996137671, - 5.383307584024402 - ], - "translation_norm_m": 0.056957467742364654, - "rotation_rpy_deg_xyz": [ - 0.8183862469518515, - 2.814848675607942, - 0.5985715834850913 - ], - "rotation_angle_deg": 2.987831659342916, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03546052372719943, - 0.005627029377727855, - 0.18763482467988143 - ], - "translation_xyz_cm": [ - 3.5460523727199433, - 0.5627029377727855, - 18.763482467988144 - ], - "translation_norm_m": 0.19103910498972437, - "rotation_rpy_deg_xyz": [ - 0.08056407120942939, - -0.027811541962529596, - -0.22623109048306794 - ], - "rotation_angle_deg": 0.24173477443327523, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.038240202321851324, - 0.01353115964024143, - 0.32554391878238415 - ], - "translation_xyz_cm": [ - 3.8240202321851324, - 1.353115964024143, - 32.55439187823841 - ], - "translation_norm_m": 0.32806134854782476, - "rotation_rpy_deg_xyz": [ - -0.167114628070881, - 0.18898658982808883, - -0.24161677515642194 - ], - "rotation_angle_deg": 0.3491254690094015, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.028951205995697116, - 0.01869678512644546, - 0.07153965459476203 - ], - "translation_xyz_cm": [ - 2.8951205995697116, - 1.8696785126445459, - 7.153965459476202 - ], - "translation_norm_m": 0.07940821293926477, - "rotation_rpy_deg_xyz": [ - 0.8829950281810196, - -2.2502562677989584, - -0.789233589731784 - ], - "rotation_angle_deg": 2.537451603218327, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009353534771014083, - 0.025801965994757037, - 0.20909235946409352 - ], - "translation_xyz_cm": [ - -0.9353534771014083, - 2.5801965994757037, - 20.909235946409353 - ], - "translation_norm_m": 0.21088585739249768, - "rotation_rpy_deg_xyz": [ - 0.6245978375454887, - -0.5448070021427569, - -0.731667195230908 - ], - "rotation_angle_deg": 1.1035924496542437, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0019342858388236017, - -0.021119817917036876, - 0.16338179459045502 - ], - "translation_xyz_cm": [ - -0.19342858388236017, - -2.1119817917036876, - 16.338179459045502 - ], - "translation_norm_m": 0.16475253859699007, - "rotation_rpy_deg_xyz": [ - -1.0250639829962782, - 0.597396633687694, - -0.025949769318696 - ], - "rotation_angle_deg": 1.186602463605637, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.00573269125079201, - -0.007978562485996932, - -0.061622627561909005 - ], - "translation_xyz_cm": [ - 0.573269125079201, - -0.7978562485996932, - -6.1622627561909 - ], - "translation_norm_m": 0.062400876884492675, - "rotation_rpy_deg_xyz": [ - -0.4360293440208008, - 0.5253853696439899, - 0.08833799443998212 - ], - "rotation_angle_deg": 0.6886993179318968, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0016790851192740597, - 0.028014497123319382, - 0.06207745456358598 - ], - "translation_xyz_cm": [ - 0.16790851192740597, - 2.801449712331938, - 6.207745456358598 - ], - "translation_norm_m": 0.06812665954679063, - "rotation_rpy_deg_xyz": [ - -0.805796448146912, - 0.11944509785317334, - -0.717313838332453 - ], - "rotation_angle_deg": 1.084850361243748, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014916978532939495, - -0.04331079419256367, - -0.013270266372165749 - ], - "translation_xyz_cm": [ - 1.4916978532939495, - -4.331079419256367, - -1.3270266372165749 - ], - "translation_norm_m": 0.04769110097000297, - "rotation_rpy_deg_xyz": [ - 0.12912467724965815, - 0.3847471464276294, - -0.6264223605656299 - ], - "rotation_angle_deg": 0.7467596543469531, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.01868835318456563, - -0.0135554851393338, - -0.000688822107509271 - ], - "translation_xyz_cm": [ - -1.8688353184565631, - -1.35554851393338, - -0.0688822107509271 - ], - "translation_norm_m": 0.023097190262227944, - "rotation_rpy_deg_xyz": [ - 0.23539998757604674, - -0.4326996857174463, - -0.7148435840230071 - ], - "rotation_angle_deg": 0.867392240374929, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012676751441990763, - 0.021818569930967424, - -0.06974120213637103 - ], - "translation_xyz_cm": [ - 1.2676751441990763, - 2.1818569930967424, - -6.974120213637103 - ], - "translation_norm_m": 0.07416593083337317, - "rotation_rpy_deg_xyz": [ - 0.47791772305016356, - 0.27916173524938387, - 0.14467147427913288 - ], - "rotation_angle_deg": 0.5717770281306348, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.008853518207382394, - 0.005960923900562687, - 0.015448720836625282 - ], - "translation_xyz_cm": [ - 0.8853518207382394, - 0.5960923900562687, - 1.5448720836625283 - ], - "translation_norm_m": 0.018777123685078372, - "rotation_rpy_deg_xyz": [ - 0.9007689021403367, - 0.6622423345593356, - 0.010992172985308342 - ], - "rotation_angle_deg": 1.1180102289992853, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0058446652337726945, - -0.017365674858811297, - -0.021144153153372813 - ], - "translation_xyz_cm": [ - 0.5844665233772695, - -1.7365674858811297, - -2.1144153153372813 - ], - "translation_norm_m": 0.027978598742076193, - "rotation_rpy_deg_xyz": [ - -1.3773700111501186, - -1.0046354564768039, - 0.14844688554277913 - ], - "rotation_angle_deg": 1.710216840374214, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.01390212969496396, - 0.002496752745082237, - 0.017943920255665047 - ], - "translation_xyz_cm": [ - 1.390212969496396, - 0.2496752745082237, - 1.7943920255665047 - ], - "translation_norm_m": 0.022836095517126846, - "rotation_rpy_deg_xyz": [ - -0.43251611498723447, - -0.5171793907365585, - -0.1326779479823704 - ], - "rotation_angle_deg": 0.6875061195545844, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0018591275690957865, - -0.02365138786226384, - 0.026419006880905177 - ], - "translation_xyz_cm": [ - 0.18591275690957865, - -2.365138786226384, - 2.6419006880905176 - ], - "translation_norm_m": 0.03550786430782241, - "rotation_rpy_deg_xyz": [ - 0.9644250844964172, - -0.052347541193340036, - -0.2061288453054149 - ], - "rotation_angle_deg": 0.9875031197244521, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.002457793410303666, - 0.019464343615029023, - -0.07026082206944219 - ], - "translation_xyz_cm": [ - -0.24577934103036658, - 1.9464343615029023, - -7.026082206944219 - ], - "translation_norm_m": 0.07294850607576188, - "rotation_rpy_deg_xyz": [ - 0.1793600543540474, - 1.3347198219168817, - 0.08766164359274631 - ], - "rotation_angle_deg": 1.3494308118705296, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007582045565697415, - 0.02444903680899646, - 0.04290166956993525 - ], - "translation_xyz_cm": [ - -0.7582045565697415, - 2.444903680899646, - 4.290166956993525 - ], - "translation_norm_m": 0.04995794298943746, - "rotation_rpy_deg_xyz": [ - 0.3914967997392125, - 1.05688935993836, - -0.27607706839971735 - ], - "rotation_angle_deg": 1.1612451649773918, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0017580054626740171, - -0.033495691369310854, - -0.07036552140497883 - ], - "translation_xyz_cm": [ - 0.1758005462674017, - -3.3495691369310854, - -7.036552140497883 - ], - "translation_norm_m": 0.07795100080248778, - "rotation_rpy_deg_xyz": [ - 0.01450728535636507, - 0.6075758458550363, - -0.09633437625474427 - ], - "rotation_angle_deg": 0.6153486107558056, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.00045769367719517007, - 0.037106371232296986, - -0.06184429404327041 - ], - "translation_xyz_cm": [ - 0.04576936771951701, - 3.7106371232296986, - -6.184429404327041 - ], - "translation_norm_m": 0.07212356740512545, - "rotation_rpy_deg_xyz": [ - -0.33787320753256816, - 1.1969616992427536, - 0.20752613984499257 - ], - "rotation_angle_deg": 1.261507704806115, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.020384204436314945, - 0.013384668967432178, - -0.07899152078374128 - ], - "translation_xyz_cm": [ - -2.0384204436314945, - 1.3384668967432178, - -7.899152078374128 - ], - "translation_norm_m": 0.08266997949435728, - "rotation_rpy_deg_xyz": [ - 0.4612327046110624, - -0.06526869867707745, - 0.35588058351661483 - ], - "rotation_angle_deg": 0.5863726331266372, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.024791214050660537, - 0.01645717714018491, - -0.078394528575768 - ], - "translation_xyz_cm": [ - -2.4791214050660537, - 1.6457177140184909, - -7.839452857576799 - ], - "translation_norm_m": 0.08385192355662449, - "rotation_rpy_deg_xyz": [ - -0.08549117967155997, - 0.5564635143849636, - 0.07267197946558421 - ], - "rotation_angle_deg": 0.5677163384042012, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.029820077708732184, - 0.024280617268751192, - -0.054042386439153565 - ], - "translation_xyz_cm": [ - -2.9820077708732184, - 2.4280617268751192, - -5.404238643915357 - ], - "translation_norm_m": 0.06632770870115455, - "rotation_rpy_deg_xyz": [ - 0.21954485418706304, - 0.725256317539506, - 0.3171336492314722 - ], - "rotation_angle_deg": 0.8209062000933968, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009677430816166677, - -0.008142171696082112, - -0.06169482511417106 - ], - "translation_xyz_cm": [ - -0.9677430816166677, - -0.8142171696082112, - -6.169482511417106 - ], - "translation_norm_m": 0.06297776649737846, - "rotation_rpy_deg_xyz": [ - 0.7879001511137325, - 0.5196169275597683, - 0.48259960238508876 - ], - "rotation_angle_deg": 1.058410527735727, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.01592885894227547, - -0.01638850991084273, - -0.01642241391231333 - ], - "translation_xyz_cm": [ - 1.592885894227547, - -1.638850991084273, - -1.642241391231333 - ], - "translation_norm_m": 0.028142627507182803, - "rotation_rpy_deg_xyz": [ - -0.32938534818192683, - -0.3108424883964883, - -0.24039386678154245 - ], - "rotation_angle_deg": 0.5131627282850031, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007501163574562875, - 0.00017185060405455754, - -0.04335310838929353 - ], - "translation_xyz_cm": [ - -0.7501163574562875, - 0.017185060405455754, - -4.335310838929353 - ], - "translation_norm_m": 0.04399760214621128, - "rotation_rpy_deg_xyz": [ - 0.7190537406403299, - 0.47079605438569244, - 0.26735051839460294 - ], - "rotation_angle_deg": 0.8992105633635359, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0019896264825605137, - 0.0035788964129528367, - 0.05179175523121066 - ], - "translation_xyz_cm": [ - 0.19896264825605137, - 0.35788964129528367, - 5.179175523121065 - ], - "translation_norm_m": 0.05195337354786876, - "rotation_rpy_deg_xyz": [ - 0.9352451557534558, - -0.2306034681683019, - -0.2843330793244963 - ], - "rotation_angle_deg": 1.0038094437073084, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.012148060333716959, - 0.012918639866679626, - 0.0017808561842288656 - ], - "translation_xyz_cm": [ - -1.214806033371696, - 1.2918639866679626, - 0.17808561842288656 - ], - "translation_norm_m": 0.017822403727485746, - "rotation_rpy_deg_xyz": [ - 0.8592726675095829, - 0.6753113730237144, - 0.4174775805301984 - ], - "rotation_angle_deg": 1.1680927030012243, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.006756345285543031, - -0.00157332550914413, - -0.03679516277345679 - ], - "translation_xyz_cm": [ - -0.6756345285543031, - -0.157332550914413, - -3.6795162773456793 - ], - "translation_norm_m": 0.03744339138353234, - "rotation_rpy_deg_xyz": [ - -0.6419225707139019, - 0.6580131976474313, - -0.30301826532176407 - ], - "rotation_angle_deg": 0.9667603772588841, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.009203818333346714, - 0.01775387031734077, - 0.14205706478897084 - ], - "translation_xyz_cm": [ - 0.9203818333346714, - 1.775387031734077, - 14.205706478897085 - ], - "translation_norm_m": 0.1434577284067194, - "rotation_rpy_deg_xyz": [ - 1.5303808387544897, - -0.08824095927814816, - -0.49491216413082645 - ], - "rotation_angle_deg": 1.6104684040594357, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004274702285772758, - 0.007118039742001647, - 0.07177150772979493 - ], - "translation_xyz_cm": [ - 0.4274702285772758, - 0.7118039742001647, - 7.177150772979493 - ], - "translation_norm_m": 0.07225018263789178, - "rotation_rpy_deg_xyz": [ - 0.9845723312887034, - 0.3991492552722418, - 0.1829113110169082 - ], - "rotation_angle_deg": 1.0774506414919525, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.009676293087441223, - 0.015062422446934232, - 0.01613170389617781 - ], - "translation_xyz_cm": [ - 0.9676293087441223, - 1.5062422446934232, - 1.613170389617781 - ], - "translation_norm_m": 0.02409852876168853, - "rotation_rpy_deg_xyz": [ - 0.5446609972549877, - 1.0891686060575962, - -0.5105318945205896 - ], - "rotation_angle_deg": 1.3224423834262307, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00842295167889251, - 0.04215678502635711, - 0.09022626872284951 - ], - "translation_xyz_cm": [ - -0.842295167889251, - 4.215678502635711, - 9.02262687228495 - ], - "translation_norm_m": 0.0999445856782212, - "rotation_rpy_deg_xyz": [ - -1.2299705809582755, - -0.3895582756975371, - 0.6248192179435135 - ], - "rotation_angle_deg": 1.431689512220254, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02073089057699473, - 0.026495752612993417, - 0.07473173772288842 - ], - "translation_xyz_cm": [ - 2.073089057699473, - 2.6495752612993417, - 7.473173772288842 - ], - "translation_norm_m": 0.0819550325100714, - "rotation_rpy_deg_xyz": [ - -0.5553391084961746, - -0.2218605192185164, - 0.5024152189596192 - ], - "rotation_angle_deg": 0.7803599208395339, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006724482050097125, - -0.030619505808932523, - 0.012756462039965916 - ], - "translation_xyz_cm": [ - -0.6724482050097125, - -3.061950580893252, - 1.2756462039965917 - ], - "translation_norm_m": 0.033845237753669606, - "rotation_rpy_deg_xyz": [ - 0.1414730484303835, - -0.6601869232996502, - -0.12355619163179575 - ], - "rotation_angle_deg": 0.6862402792265658, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.02659792246017334, - 0.036920901221063396, - -0.045555009706722285 - ], - "translation_xyz_cm": [ - -2.659792246017334, - 3.6920901221063396, - -4.555500970672228 - ], - "translation_norm_m": 0.06438836335513178, - "rotation_rpy_deg_xyz": [ - -1.3900545778064823, - -0.7504369163910435, - -0.06517804593472937 - ], - "rotation_angle_deg": 1.5813962931760814, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.007681261939971318, - 0.04595189287401458, - -0.0039005470666954173 - ], - "translation_xyz_cm": [ - 0.7681261939971318, - 4.595189287401458, - -0.39005470666954173 - ], - "translation_norm_m": 0.04675245994720353, - "rotation_rpy_deg_xyz": [ - -0.960898043933973, - -0.230695715801806, - -0.08311194361449237 - ], - "rotation_angle_deg": 0.9918534656954411, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0018552652798797808, - -0.0071570173143215565, - 0.03541789527911139 - ], - "translation_xyz_cm": [ - -0.18552652798797808, - -0.7157017314321557, - 3.5417895279111393 - ], - "translation_norm_m": 0.036181379355938424, - "rotation_rpy_deg_xyz": [ - 0.3534023340606155, - -1.1921122872653018, - 0.23188943907443324 - ], - "rotation_angle_deg": 1.2655023081086867, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.02073888117250755, - 0.006184542712919294, - 0.04770820630403747 - ], - "translation_xyz_cm": [ - -2.073888117250755, - 0.6184542712919294, - 4.7708206304037475 - ], - "translation_norm_m": 0.05238723804137714, - "rotation_rpy_deg_xyz": [ - -0.7634181220509364, - -1.1723232863478092, - 0.17035240698319906 - ], - "rotation_angle_deg": 1.408363000887622, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0005502548438546251, - 0.025584761211834728, - -0.0383739595032095 - ], - "translation_xyz_cm": [ - 0.05502548438546251, - 2.558476121183473, - -3.8373959503209503 - ], - "translation_norm_m": 0.04612421874258415, - "rotation_rpy_deg_xyz": [ - -0.12114922839086474, - -0.386679112464311, - 0.09702029770159977 - ], - "rotation_angle_deg": 0.4165709898091055, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012408532593514154, - 0.02536791354987944, - -0.08414533738114009 - ], - "translation_xyz_cm": [ - 1.2408532593514154, - 2.536791354987944, - -8.41453373811401 - ], - "translation_norm_m": 0.08875776316460635, - "rotation_rpy_deg_xyz": [ - 0.6745676850684716, - -0.3060770225299964, - 0.09295321375203387 - ], - "rotation_angle_deg": 0.7467923184060317, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.010885765367002698, - 0.002553689848818985, - -0.0023080105159179673 - ], - "translation_xyz_cm": [ - -1.0885765367002698, - 0.2553689848818985, - -0.23080105159179673 - ], - "translation_norm_m": 0.011417010642501146, - "rotation_rpy_deg_xyz": [ - 0.16866821200792917, - -0.2158382369761753, - -0.05406807506538004 - ], - "rotation_angle_deg": 0.2791488377333452, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01480238272588874, - 0.029697391827407937, - -0.05223227062282755 - ], - "translation_xyz_cm": [ - 1.480238272588874, - 2.9697391827407937, - -5.2232270622827555 - ], - "translation_norm_m": 0.06188098019691171, - "rotation_rpy_deg_xyz": [ - 0.5906111929634549, - 0.1920832645951842, - -0.14654419068204427 - ], - "rotation_angle_deg": 0.6383434689820986, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.021745385136121786, - 0.023949428447166188, - 0.02506576697712644 - ], - "translation_xyz_cm": [ - 2.1745385136121786, - 2.394942844716619, - 2.506576697712644 - ], - "translation_norm_m": 0.040923459919901706, - "rotation_rpy_deg_xyz": [ - 0.9888799347255527, - 0.2785721774994646, - -0.08612790171250141 - ], - "rotation_angle_deg": 1.0311721345870892, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0018555680242564598, - -0.001501007969074264, - 0.013922761333685592 - ], - "translation_xyz_cm": [ - -0.18555680242564598, - -0.1501007969074264, - 1.3922761333685592 - ], - "translation_norm_m": 0.01412584301097241, - "rotation_rpy_deg_xyz": [ - 0.6674498394736863, - -0.126487353370166, - 0.005478217447649107 - ], - "rotation_angle_deg": 0.6793572259021452, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.08112855253557916, - "improved_pairs": 35, - "worsened_pairs": 45, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07613696756808985, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152192452926, - 0.0011901746480735614, - 0.7182307404781154 - ], - "rotation_rpy_deg_xyz": [ - -0.886624718165571, - 1.3011901167388817, - -0.8376398312653468 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.1195801596045202, - "median": 0.0636357701793885, - "p90": 0.1930339541696916, - "p95": 0.2377579428192093, - "max": 0.39017136286527976 - }, - "rotation_deg": { - "rms": 1.1676828282839524, - "median": 0.9007418533615423, - "p90": 1.7178118653840067, - "p95": 2.248294665968699, - "max": 2.919819960959544 - }, - "normalized_pair_score": { - "rms": 3.342708269995132, - "median": 2.5220116457960895, - "p90": 5.144164320529704, - "p95": 5.963693877046038, - "max": 8.356197300307858 - }, - "normalized_global_rms": 3.342708269995132 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018231454938502534, - 0.020821627337128223, - 0.08565551304042374 - ], - "translation_xyz_cm": [ - -1.8231454938502534, - 2.0821627337128223, - 8.565551304042373 - ], - "translation_norm_m": 0.09001551548682646, - "rotation_rpy_deg_xyz": [ - 0.3905436490563188, - 0.12372824804853423, - 0.09530466362059302 - ], - "rotation_angle_deg": 0.4205181630564456, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6807154082401394, - "median": 0.7133278004221145, - "p90": 2.3175185373442213, - "p95": 3.9104710727627636, - "max": 5.650741373677544 - }, - "height_residual_m": { - "rms": 0.03471396517121729, - "median": -0.005924101606088833, - "p90": 0.053409267341990765, - "p95": 0.08720196104337453, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018231454938502534, - 0.020821627337128223, - 0.08565551304042374 - ], - "translation_xyz_cm": [ - -1.8231454938502534, - 2.0821627337128223, - 8.565551304042373 - ], - "translation_norm_m": 0.09001551548682646, - "rotation_rpy_deg_xyz": [ - 0.3905436490563188, - 0.12372824804853423, - 0.09530466362059302 - ], - "rotation_angle_deg": 0.4205181630564456, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.01974934868799627, - -0.02361695178996337, - 0.16950518184901292 - ], - "translation_xyz_cm": [ - 1.974934868799627, - -2.361695178996337, - 16.95051818490129 - ], - "translation_norm_m": 0.17227827448380267, - "rotation_rpy_deg_xyz": [ - -0.3607825176662316, - -0.27196447234352794, - -0.354880031824127 - ], - "rotation_angle_deg": 0.5750438048997064, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030424926243355577, - 0.0036625984740648043, - 0.14899570431420397 - ], - "translation_xyz_cm": [ - 3.0424926243355577, - 0.36625984740648043, - 14.899570431420397 - ], - "translation_norm_m": 0.15211446567825676, - "rotation_rpy_deg_xyz": [ - -0.0537731798274731, - -0.1830796104619263, - -0.38980043111280266 - ], - "rotation_angle_deg": 0.4340747732687158, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.00816214363974687, - -0.0003463534967551585, - 0.10058953616799772 - ], - "translation_xyz_cm": [ - -0.816214363974687, - -0.03463534967551585, - 10.058953616799773 - ], - "translation_norm_m": 0.1009207378888675, - "rotation_rpy_deg_xyz": [ - 0.5872615212616019, - 0.2446434487018132, - 0.20612175977736819 - ], - "rotation_angle_deg": 0.668352361082244, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.01811568568228572, - -0.0031204636328168167, - -0.027665342706942243 - ], - "translation_xyz_cm": [ - -1.811568568228572, - -0.31204636328168167, - -2.7665342706942244 - ], - "translation_norm_m": 0.03321575752734937, - "rotation_rpy_deg_xyz": [ - 0.5684473403720353, - 0.04826617937223907, - 0.06085713181067484 - ], - "rotation_angle_deg": 0.5737041061852833, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03112745205181411, - -0.018044531212046022, - 0.07364400645478726 - ], - "translation_xyz_cm": [ - 3.112745205181411, - -1.8044531212046022, - 7.364400645478726 - ], - "translation_norm_m": 0.0819631811523518, - "rotation_rpy_deg_xyz": [ - 0.382289428856501, - 0.08741206916264015, - -0.3433009633825148 - ], - "rotation_angle_deg": 0.52138408515289, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04311589641261393, - 0.006352173539995287, - 0.06364123232199209 - ], - "translation_xyz_cm": [ - 4.311589641261393, - 0.6352173539995287, - 6.364123232199209 - ], - "translation_norm_m": 0.07713324240304723, - "rotation_rpy_deg_xyz": [ - 0.7133801681543233, - 0.4241735375061574, - -0.3586032677638113 - ], - "rotation_angle_deg": 0.905163013659495, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.001420149131622056, - -0.004523334169803217, - -0.0002752900680577722 - ], - "translation_xyz_cm": [ - 0.1420149131622056, - -0.4523334169803217, - -0.027529006805777217 - ], - "translation_norm_m": 0.0047490167602702235, - "rotation_rpy_deg_xyz": [ - 0.9612585211267437, - 0.41826610543981535, - 0.026199239136182023 - ], - "rotation_angle_deg": 1.048552768728506, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.00531080680304637, - 0.01928517772982405, - 0.0011536267581689094 - ], - "translation_xyz_cm": [ - 0.5310806803046371, - 1.928517772982405, - 0.11536267581689094 - ], - "translation_norm_m": 0.020036307136479727, - "rotation_rpy_deg_xyz": [ - 0.35920347004395264, - 0.26492094720138204, - -0.024196751626700944 - ], - "rotation_angle_deg": 0.44702984088103037, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.038128802734328004, - -0.002710311285406386, - -0.03552921194593247 - ], - "translation_xyz_cm": [ - -3.8128802734328007, - -0.2710311285406386, - -3.552921194593247 - ], - "translation_norm_m": 0.05218693597746557, - "rotation_rpy_deg_xyz": [ - 0.7512852164600878, - 0.983192748355844, - 0.5793496502126471 - ], - "rotation_angle_deg": 1.3635422959727628, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04922179929185885, - -0.025248986546982377, - -0.04495814644890103 - ], - "translation_xyz_cm": [ - -4.922179929185885, - -2.5248986546982377, - -4.495814644890103 - ], - "translation_norm_m": 0.07128486360580741, - "rotation_rpy_deg_xyz": [ - 0.8259695920152894, - 1.5618176858532224, - 0.49758461024927164 - ], - "rotation_angle_deg": 1.8324370985378327, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03270798512540499, - -0.020333247308202074, - -0.04334661211128648 - ], - "translation_xyz_cm": [ - -3.2707985125404986, - -2.0333247308202074, - -4.3346612111286476 - ], - "translation_norm_m": 0.05798432562845367, - "rotation_rpy_deg_xyz": [ - 0.56529016958967, - 0.5417302703346552, - 0.6003521955826407 - ], - "rotation_angle_deg": 0.9850028758444649, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.039653999439997256, - -0.0407629946554281, - -0.05256447693126255 - ], - "translation_xyz_cm": [ - -3.9653999439997256, - -4.07629946554281, - -5.256447693126256 - ], - "translation_norm_m": 0.07744085252580188, - "rotation_rpy_deg_xyz": [ - 0.7804656086086982, - 1.0905038167902201, - 0.5213191404971134 - ], - "rotation_angle_deg": 1.4360794031807464, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012124184539423627, - -0.013339727202540036, - -0.010157362490326949 - ], - "translation_xyz_cm": [ - -1.2124184539423628, - -1.3339727202540037, - -1.0157362490326949 - ], - "translation_norm_m": 0.02069096869032686, - "rotation_rpy_deg_xyz": [ - 0.41371318968478743, - 0.386499132038145, - -0.08569258492997359 - ], - "rotation_angle_deg": 0.5728192050480228, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.010298725958886645, - -0.012299146072011255, - -0.1909913851976119 - ], - "translation_xyz_cm": [ - 1.0298725958886645, - -1.2299146072011256, - -19.09913851976119 - ], - "translation_norm_m": 0.19166387758307377, - "rotation_rpy_deg_xyz": [ - -0.8517486162122222, - 0.23440280727776613, - 0.33140698149260456 - ], - "rotation_angle_deg": 0.944141196125912, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0010675293296742439, - 0.01017682791954782, - -0.2359441068505602 - ], - "translation_xyz_cm": [ - 0.10675293296742439, - 1.017682791954782, - -23.59441068505602 - ], - "translation_norm_m": 0.23616589297119592, - "rotation_rpy_deg_xyz": [ - -0.5170652430241701, - -0.09478957942492744, - 0.43313074423694686 - ], - "rotation_angle_deg": 0.6808611330445697, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.003970434017058655, - 0.0015140983890497561, - -0.023416135878904717 - ], - "translation_xyz_cm": [ - -0.3970434017058655, - 0.1514098389049756, - -2.3416135878904716 - ], - "translation_norm_m": 0.023798576842216184, - "rotation_rpy_deg_xyz": [ - 0.12687886019996733, - 0.11679040509532602, - -0.09585545276986342 - ], - "rotation_angle_deg": 0.1973608117336857, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.002316377625960833, - 0.027841357885924456, - -0.2665467805780039 - ], - "translation_xyz_cm": [ - 0.23163776259608332, - 2.7841357885924456, - -26.65467805780039 - ], - "translation_norm_m": 0.26800688993146565, - "rotation_rpy_deg_xyz": [ - -0.6821233614928507, - 0.14220235371992707, - 0.06772460508201025 - ], - "rotation_angle_deg": 0.7001533914838783, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0017515255665714324, - 0.014690937863870879, - -0.16475825589415047 - ], - "translation_xyz_cm": [ - -0.17515255665714324, - 1.4690937863870879, - -16.475825589415045 - ], - "translation_norm_m": 0.1654212029408952, - "rotation_rpy_deg_xyz": [ - -0.4982912411373836, - 0.7836073524791359, - 0.2772075186318245 - ], - "rotation_angle_deg": 0.9700836251671574, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.007563173186210415, - 0.026473118972467402, - 0.005729535674388608 - ], - "translation_xyz_cm": [ - 0.7563173186210415, - 2.64731189724674, - 0.5729535674388608 - ], - "translation_norm_m": 0.028122147781048257, - "rotation_rpy_deg_xyz": [ - 0.3024456660331904, - -0.7107398582074821, - -0.24838645045074725 - ], - "rotation_angle_deg": 0.8107936613163664, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.01355996822738037, - -0.02867391488174579, - -0.02321315168419319 - ], - "translation_xyz_cm": [ - -1.355996822738037, - -2.867391488174579, - -2.3213151684193187 - ], - "translation_norm_m": 0.0393054263949207, - "rotation_rpy_deg_xyz": [ - 0.1025528630242556, - -0.2779611080408971, - -0.4784908294130637 - ], - "rotation_angle_deg": 0.5625783077210534, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.005838509924486646, - 0.00784964623843104, - -0.005353765610752341 - ], - "translation_xyz_cm": [ - 0.5838509924486646, - 0.7849646238431041, - -0.5353765610752341 - ], - "translation_norm_m": 0.01115203794925923, - "rotation_rpy_deg_xyz": [ - 0.48245896210619127, - -0.50819894266298, - -0.4801671128502027 - ], - "rotation_angle_deg": 0.8482535579148521, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.0185156522662675, - 0.011675017321113756, - -0.2041947633284075 - ], - "translation_xyz_cm": [ - -1.8515652266267502, - 1.1675017321113756, - -20.41947633284075 - ], - "translation_norm_m": 0.205364643449251, - "rotation_rpy_deg_xyz": [ - -0.6674101969345277, - 1.1538786470897484, - -0.6407885997497481 - ], - "rotation_angle_deg": 1.476088053712301, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.028181523469963915, - 0.025353685281518157, - -0.22622508576058842 - ], - "translation_xyz_cm": [ - -2.8181523469963916, - 2.5353685281518157, - -22.62250857605884 - ], - "translation_norm_m": 0.22937915565680325, - "rotation_rpy_deg_xyz": [ - -0.21430115887061138, - 1.0467798508471517, - -0.41059508610735057 - ], - "rotation_angle_deg": 1.143961376181365, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011557463653927458, - 0.030107046372862212, - -0.03705971677165668 - ], - "translation_xyz_cm": [ - 1.1557463653927458, - 3.010704637286221, - -3.7059716771656683 - ], - "translation_norm_m": 0.04912669146813106, - "rotation_rpy_deg_xyz": [ - 0.36988996561214493, - -0.08732771530347576, - -0.01099388151868844 - ], - "rotation_angle_deg": 0.3802096224460754, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01274099878547319, - 0.04416910043141464, - -0.13915390596865584 - ], - "translation_xyz_cm": [ - 1.274099878547319, - 4.416910043141464, - -13.915390596865585 - ], - "translation_norm_m": 0.1465505101639204, - "rotation_rpy_deg_xyz": [ - -0.4960493863782202, - -0.21577392390568093, - 0.1638841280041057 - ], - "rotation_angle_deg": 0.564955524196428, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005928766491923032, - 0.01825423116397973, - -0.08901112759084634 - ], - "translation_xyz_cm": [ - 0.5928766491923032, - 1.8254231163979728, - -8.901112759084635 - ], - "translation_norm_m": 0.0910568397348474, - "rotation_rpy_deg_xyz": [ - -0.7269430277208271, - -0.10958094368316808, - 0.16236987642198605 - ], - "rotation_angle_deg": 0.7527229621250775, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.009979779028273406, - -0.025432656902994122, - -0.16963282817721448 - ], - "translation_xyz_cm": [ - -0.9979779028273406, - -2.543265690299412, - -16.96328281772145 - ], - "translation_norm_m": 0.17181883605122855, - "rotation_rpy_deg_xyz": [ - -0.8115528165822133, - 2.3406713788228672, - -0.37239009377883975 - ], - "rotation_angle_deg": 2.5027136214240278, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004332562721940714, - 0.020488017087062493, - -0.023848963867417146 - ], - "translation_xyz_cm": [ - 0.43325627219407137, - 2.0488017087062493, - -2.3848963867417146 - ], - "translation_norm_m": 0.031738037454270604, - "rotation_rpy_deg_xyz": [ - 1.0296828957248496, - 0.13315122434390628, - 0.2210796245064315 - ], - "rotation_angle_deg": 1.061282939085634, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.008050854271534291, - 0.03587436949752787, - 0.055722371343603666 - ], - "translation_xyz_cm": [ - 0.8050854271534291, - 3.587436949752787, - 5.572237134360367 - ], - "translation_norm_m": 0.06675903915951084, - "rotation_rpy_deg_xyz": [ - 1.1857122830857452, - 1.6563335885334793, - 0.15818309955579676 - ], - "rotation_angle_deg": 2.041777132046322, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.012023828959291105, - 0.005122361513606677, - -0.030832240981868105 - ], - "translation_xyz_cm": [ - -1.2023828959291105, - 0.5122361513606677, - -3.0832240981868106 - ], - "translation_norm_m": 0.033487880408923365, - "rotation_rpy_deg_xyz": [ - -0.15995252611301033, - 2.532338147919116, - 0.6904455915549447 - ], - "rotation_angle_deg": 2.630558013595305, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.00927597101889277, - 0.002884687610644976, - 0.3893306980907686 - ], - "translation_xyz_cm": [ - 0.927597101889277, - 0.2884687610644976, - 38.93306980907686 - ], - "translation_norm_m": 0.38945186806176646, - "rotation_rpy_deg_xyz": [ - -1.3922637577003631, - 0.589226607770611, - -0.06810825913213205 - ], - "rotation_angle_deg": 1.513021010012132, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011454088728783951, - 0.03662834756015165, - 0.04640738351045763 - ], - "translation_xyz_cm": [ - 1.145408872878395, - 3.6628347560151653, - 4.640738351045763 - ], - "translation_norm_m": 0.06022023943725911, - "rotation_rpy_deg_xyz": [ - 1.446732649563347, - -0.330786902768802, - 0.05892161698150784 - ], - "rotation_angle_deg": 1.4854000213602094, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0054328940492403, - 0.01692646253974872, - 0.00012444761555579532 - ], - "translation_xyz_cm": [ - -0.54328940492403, - 1.6926462539748721, - 0.012444761555579532 - ], - "translation_norm_m": 0.017777428359265154, - "rotation_rpy_deg_xyz": [ - 0.08152574360359642, - 2.179803089006463, - 0.4880081884277956 - ], - "rotation_angle_deg": 2.2349041946289456, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03107012047078439, - 0.02463621996407106, - 0.14977020734075666 - ], - "translation_xyz_cm": [ - 3.107012047078439, - 2.463621996407106, - 14.977020734075666 - ], - "translation_norm_m": 0.15493034153154245, - "rotation_rpy_deg_xyz": [ - -0.13149350525070763, - -0.6963629717915615, - -0.2990178157789108 - ], - "rotation_angle_deg": 0.7694804136245109, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.006149945037087601, - 0.011576284335908404, - 0.3899510997768372 - ], - "translation_xyz_cm": [ - 0.6149945037087601, - 1.1576284335908404, - 38.99510997768372 - ], - "translation_norm_m": 0.39017136286527976, - "rotation_rpy_deg_xyz": [ - -0.686626158133473, - 0.5748813978761722, - -0.24770876017132035 - ], - "rotation_angle_deg": 0.9282197933743503, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.015041998059776684, - 0.01143952631168188, - 0.055985780558058584 - ], - "translation_xyz_cm": [ - -1.5041998059776684, - 1.143952631168188, - 5.598578055805858 - ], - "translation_norm_m": 0.05908918761128027, - "rotation_rpy_deg_xyz": [ - 0.8947213219084389, - 2.7191234056912905, - 0.5973083488266634 - ], - "rotation_angle_deg": 2.919819960959544, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.033950551172448384, - 0.0038047233098106314, - 0.1858511984602926 - ], - "translation_xyz_cm": [ - 3.3950551172448384, - 0.38047233098106314, - 18.58511984602926 - ], - "translation_norm_m": 0.1889650333090869, - "rotation_rpy_deg_xyz": [ - 0.21641524414771665, - -0.1197238067971885, - -0.22488744563009458 - ], - "rotation_angle_deg": 0.33412859468630224, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.0370751458650902, - 0.01100067101984381, - 0.32057190659469204 - ], - "translation_xyz_cm": [ - 3.7075145865090198, - 1.100067101984381, - 32.05719065946921 - ], - "translation_norm_m": 0.3228961574586488, - "rotation_rpy_deg_xyz": [ - 0.005377039355832336, - 0.1215658541324867, - -0.23870780693176405 - ], - "rotation_angle_deg": 0.26793896399249423, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.028034872744332695, - 0.018735006834420753, - 0.07174673745081792 - ], - "translation_xyz_cm": [ - 2.8034872744332695, - 1.8735006834420753, - 7.174673745081791 - ], - "translation_norm_m": 0.07927514683501583, - "rotation_rpy_deg_xyz": [ - 0.9016348921126327, - -2.3068639313877264, - -0.7906201711262257 - ], - "rotation_angle_deg": 2.5943667264769843, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010841054816514983, - 0.025447720996404577, - 0.2079067474111871 - ], - "translation_xyz_cm": [ - -1.0841054816514983, - 2.5447720996404577, - 20.790674741118707 - ], - "translation_norm_m": 0.20973871982193626, - "rotation_rpy_deg_xyz": [ - 0.6760671927966213, - -0.6307833635537007, - -0.732880639926971 - ], - "rotation_angle_deg": 1.1775387197266296, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.002555811829325183, - -0.021092877441822866, - 0.16390691807190655 - ], - "translation_xyz_cm": [ - -0.2555811829325183, - -2.1092877441822866, - 16.390691807190656 - ], - "translation_norm_m": 0.16527830905691576, - "rotation_rpy_deg_xyz": [ - -1.0147214303365089, - 0.5545504529352152, - -0.02565277081164686 - ], - "rotation_angle_deg": 1.1565396010797078, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.004843930023264664, - -0.008411724991356895, - -0.05887085840016536 - ], - "translation_xyz_cm": [ - 0.4843930023264664, - -0.8411724991356895, - -5.887085840016535 - ], - "translation_norm_m": 0.05966572503684861, - "rotation_rpy_deg_xyz": [ - -0.4057105275995083, - 0.45510288624410045, - 0.08839360414670605 - ], - "rotation_angle_deg": 0.6162929616116806, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0009788275407376368, - 0.02780439448217331, - 0.06168339672720609 - ], - "translation_xyz_cm": [ - 0.09788275407376368, - 2.780439448217331, - 6.168339672720609 - ], - "translation_norm_m": 0.06766745072544639, - "rotation_rpy_deg_xyz": [ - -0.7878446677361453, - 0.06371945158624177, - -0.7170423004709714 - ], - "rotation_angle_deg": 1.0668985791765337, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.013889543427387352, - -0.04388558339603077, - -0.008290287818272492 - ], - "translation_xyz_cm": [ - 1.3889543427387352, - -4.388558339603077, - -0.8290287818272492 - ], - "translation_norm_m": 0.0467717085292065, - "rotation_rpy_deg_xyz": [ - 0.1671548287080443, - 0.30770538187836394, - -0.6270175994478338 - ], - "rotation_angle_deg": 0.7185652314016151, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.017494534766684833, - -0.015143386740596565, - 0.00385073334201759 - ], - "translation_xyz_cm": [ - -1.7494534766684833, - -1.5143386740596565, - 0.385073334201759 - ], - "translation_norm_m": 0.02345653546347683, - "rotation_rpy_deg_xyz": [ - 0.35093559719890227, - -0.33254108332641213, - -0.710069215448556 - ], - "rotation_angle_deg": 0.8581888161699794, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01168364664458954, - 0.021363706799158777, - -0.06427344334020216 - ], - "translation_xyz_cm": [ - 1.168364664458954, - 2.1363706799158777, - -6.427344334020216 - ], - "translation_norm_m": 0.06873129626249042, - "rotation_rpy_deg_xyz": [ - 0.5065656509712979, - 0.21054419315030284, - 0.1436105346419567 - ], - "rotation_angle_deg": 0.5668278649282589, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.01014424608376513, - 0.004850582619014165, - 0.015648173101978857 - ], - "translation_xyz_cm": [ - 1.014424608376513, - 0.48505826190141654, - 1.5648173101978857 - ], - "translation_norm_m": 0.0192691256101921, - "rotation_rpy_deg_xyz": [ - 0.9887490695920423, - 0.7628571472494051, - 0.01629443850231599 - ], - "rotation_angle_deg": 1.2488443843795198, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.005056202625787876, - -0.01753340784593549, - -0.018072774283678816 - ], - "translation_xyz_cm": [ - 0.5056202625787876, - -1.753340784593549, - -1.8072774283678816 - ], - "translation_norm_m": 0.025682888194160303, - "rotation_rpy_deg_xyz": [ - -1.3614679665199831, - -1.0573183789531704, - 0.14920627508468037 - ], - "rotation_angle_deg": 1.7291549193845235, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.012498470499857417, - 0.0015581762918592812, - 0.020273776399849022 - ], - "translation_xyz_cm": [ - 1.2498470499857417, - 0.15581762918592812, - 2.0273776399849024 - ], - "translation_norm_m": 0.02386767034512153, - "rotation_rpy_deg_xyz": [ - -0.3566521447744931, - -0.6127806393536521, - -0.1318599114008229 - ], - "rotation_angle_deg": 0.7215188381709711, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0015042654167269909, - -0.026269730979473938, - 0.028419113634163967 - ], - "translation_xyz_cm": [ - 0.1504265416726991, - -2.6269730979473938, - 2.8419113634163966 - ], - "translation_norm_m": 0.038729931576616784, - "rotation_rpy_deg_xyz": [ - 1.161587142208935, - -0.07440868800455659, - -0.2024204652969098 - ], - "rotation_angle_deg": 1.1813079324219418, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.0012333027417387732, - 0.01806487402052115, - -0.06912658109668246 - ], - "translation_xyz_cm": [ - -0.12333027417387732, - 1.8064874020521149, - -6.9126581096682465 - ], - "translation_norm_m": 0.07145869382479851, - "rotation_rpy_deg_xyz": [ - 0.28918757746625234, - 1.435634327962451, - 0.09221680115638187 - ], - "rotation_angle_deg": 1.4671422125193851, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008531380572076364, - 0.02413251713866682, - 0.04524257042068578 - ], - "translation_xyz_cm": [ - -0.8531380572076364, - 2.413251713866682, - 4.524257042068578 - ], - "translation_norm_m": 0.051981275630599545, - "rotation_rpy_deg_xyz": [ - 0.4196588761469655, - 0.9887555138625159, - -0.2770337395267327 - ], - "rotation_angle_deg": 1.1101794497299484, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0004910570129568192, - -0.03486748781179394, - -0.06464759727370097 - ], - "translation_xyz_cm": [ - 0.049105701295681925, - -3.486748781179394, - -6.4647597273700965 - ], - "translation_norm_m": 0.07345266963533865, - "rotation_rpy_deg_xyz": [ - 0.11667606462689867, - 0.5090384410184795, - -0.09573857602359297 - ], - "rotation_angle_deg": 0.5310352179438377, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0006350049073620134, - 0.034689353055957106, - -0.05501838500873944 - ], - "translation_xyz_cm": [ - 0.06350049073620134, - 3.4689353055957106, - -5.501838500873944 - ], - "translation_norm_m": 0.0650444243240195, - "rotation_rpy_deg_xyz": [ - -0.13911789779705813, - 1.2143294176708672, - 0.21224887551020413 - ], - "rotation_angle_deg": 1.240815331161725, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0194989473107694, - 0.012681176291812757, - -0.07649505192189351 - ], - "translation_xyz_cm": [ - -1.94989473107694, - 1.2681176291812757, - -7.649505192189351 - ], - "translation_norm_m": 0.07995319972900009, - "rotation_rpy_deg_xyz": [ - 0.5056035167480408, - 0.019258367622050243, - 0.3589835856795076 - ], - "rotation_angle_deg": 0.6203331109287686, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.025878991354532532, - 0.01561411646638411, - -0.0763060964917768 - ], - "translation_xyz_cm": [ - -2.5878991354532532, - 1.561411646638411, - -7.63060964917768 - ], - "translation_norm_m": 0.08207401043184212, - "rotation_rpy_deg_xyz": [ - -0.023584076547292502, - 0.46544510060289146, - 0.07267612906833411 - ], - "rotation_angle_deg": 0.47168958188322396, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.030936611812901638, - 0.02281965485317472, - -0.0528381255787461 - ], - "translation_xyz_cm": [ - -3.0936611812901638, - 2.281965485317472, - -5.28381255787461 - ], - "translation_norm_m": 0.065342773990362, - "rotation_rpy_deg_xyz": [ - 0.33474352401404633, - 0.6278536423145655, - 0.31768554649514813 - ], - "rotation_angle_deg": 0.7784663066676807, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009024178463987953, - -0.01038847180293323, - -0.06068655391973522 - ], - "translation_xyz_cm": [ - -0.9024178463987953, - -1.038847180293323, - -6.068655391973523 - ], - "translation_norm_m": 0.062227116034757494, - "rotation_rpy_deg_xyz": [ - 0.9714205153553516, - 0.5759122349666784, - 0.488551978819689 - ], - "rotation_angle_deg": 1.2285071093229656, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.017031683705756695, - -0.018178973233183626, - -0.017640390149582467 - ], - "translation_xyz_cm": [ - 1.7031683705756695, - -1.8178973233183626, - -1.7640390149582468 - ], - "translation_norm_m": 0.03052436211119294, - "rotation_rpy_deg_xyz": [ - -0.18366185698637016, - -0.22052533669124247, - -0.2360129044186912 - ], - "rotation_angle_deg": 0.37179546944144876, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008149580009525814, - -7.436643985214708e-05, - -0.04223385979196097 - ], - "translation_xyz_cm": [ - -0.8149580009525814, - -0.007436643985214708, - -4.223385979196097 - ], - "translation_norm_m": 0.04301302241910066, - "rotation_rpy_deg_xyz": [ - 0.734202394819107, - 0.4193163995858751, - 0.26619988228277475 - ], - "rotation_angle_deg": 0.8856115023695521, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0009133119216304664, - 0.0016311452147088623, - 0.05157783798322549 - ], - "translation_xyz_cm": [ - 0.09133119216304664, - 0.16311452147088623, - 5.157783798322549 - ], - "translation_norm_m": 0.051611705497895705, - "rotation_rpy_deg_xyz": [ - 1.089339834308112, - -0.31328177996709633, - -0.2836462432352885 - ], - "rotation_angle_deg": 1.1677186645764397, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.012863074581246803, - 0.010456967987959587, - 0.006771028215984409 - ], - "translation_xyz_cm": [ - -1.2863074581246803, - 1.0456967987959587, - 0.6771028215984409 - ], - "translation_norm_m": 0.017906805697432086, - "rotation_rpy_deg_xyz": [ - 1.0427022083952984, - 0.6215825225300927, - 0.41987269770146407 - ], - "rotation_angle_deg": 1.2826219179392964, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.006903309850191164, - -0.004140073147248735, - -0.03208906174251945 - ], - "translation_xyz_cm": [ - -0.6903309850191164, - -0.4140073147248735, - -3.208906174251945 - ], - "translation_norm_m": 0.03308328544850922, - "rotation_rpy_deg_xyz": [ - -0.442182098035655, - 0.6524009340468228, - -0.2985233382764847 - ], - "rotation_angle_deg": 0.8418798069956956, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.008007174819792073, - 0.016657780395048505, - 0.13755626248756297 - ], - "translation_xyz_cm": [ - 0.8007174819792073, - 1.6657780395048505, - 13.755626248756297 - ], - "translation_norm_m": 0.13879236955190188, - "rotation_rpy_deg_xyz": [ - 1.6332247831326878, - -0.1867431452905089, - -0.4969077951210501 - ], - "rotation_angle_deg": 1.7165515260506157, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.003074315656183657, - 0.005167666792184722, - 0.07603344447994857 - ], - "translation_xyz_cm": [ - 0.3074315656183657, - 0.5167666792184722, - 7.603344447994857 - ], - "translation_norm_m": 0.07627083896427472, - "rotation_rpy_deg_xyz": [ - 1.1274796185260887, - 0.31024930084262264, - 0.18306436930339753 - ], - "rotation_angle_deg": 1.1831549247397253, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.008887067858567299, - 0.01260301327546598, - 0.02132290226973514 - ], - "translation_xyz_cm": [ - 0.8887067858567299, - 1.260301327546598, - 2.132290226973514 - ], - "translation_norm_m": 0.026315054245602987, - "rotation_rpy_deg_xyz": [ - 0.7263893844435342, - 1.032931016908451, - -0.5079490453780853 - ], - "rotation_angle_deg": 1.363534857852189, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0076249146008624535, - 0.04205456578223976, - 0.08496188705458683 - ], - "translation_xyz_cm": [ - -0.7624914600862454, - 4.205456578223976, - 8.496188705458684 - ], - "translation_norm_m": 0.09510650912361124, - "rotation_rpy_deg_xyz": [ - -1.2179042288787176, - -0.34044788561742667, - 0.6248468841359498 - ], - "rotation_angle_deg": 1.408931173890475, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.022243932782579634, - 0.025710203687673072, - 0.0660716455810156 - ], - "translation_xyz_cm": [ - 2.2243932782579634, - 2.571020368767307, - 6.60716455810156 - ], - "translation_norm_m": 0.0743052452326274, - "rotation_rpy_deg_xyz": [ - -0.4841316120459609, - -0.12463509898556564, - 0.5047393719614504 - ], - "rotation_angle_deg": 0.7100323200038713, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005746277160092905, - -0.03092021935892536, - 0.010050054545429468 - ], - "translation_xyz_cm": [ - -0.5746277160092905, - -3.092021935892536, - 1.0050054545429468 - ], - "translation_norm_m": 0.03301640899266265, - "rotation_rpy_deg_xyz": [ - 0.1694930459004334, - -0.5892890606210305, - -0.12156783035823678 - ], - "rotation_angle_deg": 0.6249447259839136, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.026118898983133354, - 0.03448957547108389, - -0.049003061545810786 - ], - "translation_xyz_cm": [ - -2.6118898983133354, - 3.448957547108389, - -4.900306154581078 - ], - "translation_norm_m": 0.06536840017263108, - "rotation_rpy_deg_xyz": [ - -1.1941220513244473, - -0.7211141646776168, - -0.06091038322736232 - ], - "rotation_angle_deg": 1.3966171998550332, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0075644157537730905, - 0.04348430229012712, - -0.006222057679815277 - ], - "translation_xyz_cm": [ - 0.756441575377309, - 4.3484302290127115, - -0.6222057679815276 - ], - "translation_norm_m": 0.04457374712906728, - "rotation_rpy_deg_xyz": [ - -0.7622853181223748, - -0.24534932132860585, - -0.07862192745574065 - ], - "rotation_angle_deg": 0.8048057244476345, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0009469370327210846, - -0.007346772542802138, - 0.032645458658060664 - ], - "translation_xyz_cm": [ - -0.09469370327210846, - -0.7346772542802138, - 3.2645458658060664 - ], - "translation_norm_m": 0.03347533013331994, - "rotation_rpy_deg_xyz": [ - 0.37430840421777706, - -1.1294155963559958, - 0.23378873793716043 - ], - "rotation_angle_deg": 1.213285631993869, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.019289553204528964, - 0.00500425016411854, - 0.04313014638802291 - ], - "translation_xyz_cm": [ - -1.9289553204528964, - 0.500425016411854, - 4.313014638802291 - ], - "translation_norm_m": 0.047511460827759436, - "rotation_rpy_deg_xyz": [ - -0.6673034303964166, - -1.070941091825072, - 0.17292750856427633 - ], - "rotation_angle_deg": 1.272769240123283, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.001611332747942451, - 0.023738917289845007, - -0.03796275217055782 - ], - "translation_xyz_cm": [ - 0.1611332747942451, - 2.3738917289845007, - -3.796275217055782 - ], - "translation_norm_m": 0.04480293673055246, - "rotation_rpy_deg_xyz": [ - 0.027264218551386853, - -0.297822152381515, - 0.10177047499771934 - ], - "rotation_angle_deg": 0.31593195350015424, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.013067464342826351, - 0.0230309345593549, - -0.08151345649742142 - ], - "translation_xyz_cm": [ - 1.3067464342826351, - 2.30309345593549, - -8.151345649742142 - ], - "translation_norm_m": 0.08570662845536126, - "rotation_rpy_deg_xyz": [ - 0.8558304389823626, - -0.24660377032021705, - 0.0988376470293289 - ], - "rotation_angle_deg": 0.8963206930635895, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.009870822046621264, - 0.0021546693563834207, - -0.004909753133989517 - ], - "translation_xyz_cm": [ - -0.9870822046621264, - 0.21546693563834207, - -0.4909753133989517 - ], - "translation_norm_m": 0.011233049619231725, - "rotation_rpy_deg_xyz": [ - 0.20330756762764324, - -0.13869823897718012, - -0.05176976796705038 - ], - "rotation_angle_deg": 0.2514473590478504, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.015962829874078155, - 0.028583502182210507, - -0.050427740372957046 - ], - "translation_xyz_cm": [ - 1.5962829874078155, - 2.8583502182210507, - -5.042774037295705 - ], - "translation_norm_m": 0.06012308652848385, - "rotation_rpy_deg_xyz": [ - 0.6739046154379048, - 0.2920543118758534, - -0.14191490490768147 - ], - "rotation_angle_deg": 0.7483777287199259, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.02236327603089716, - 0.023708869430539625, - 0.02597721894181454 - ], - "translation_xyz_cm": [ - 2.236327603089716, - 2.3708869430539625, - 2.597721894181454 - ], - "translation_norm_m": 0.04167784193620687, - "rotation_rpy_deg_xyz": [ - 1.00257693408983, - 0.33051668921740535, - -0.0840644587475636 - ], - "rotation_angle_deg": 1.0592222716675146, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0012922878144319139, - -0.0015801690368494326, - 0.013353850779159585 - ], - "translation_xyz_cm": [ - -0.1292287814431914, - -0.15801690368494326, - 1.3353850779159584 - ], - "translation_norm_m": 0.013508970079632567, - "rotation_rpy_deg_xyz": [ - 0.6765054103210028, - -0.08342963569141254, - 0.006893118170914629 - ], - "rotation_angle_deg": 0.6816702268633947, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.046472652770396916, - "improved_pairs": 34, - "worsened_pairs": 46, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.03779273410144712, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.100_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.1, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2990152188350905, - -0.00132483596826191, - 0.7182305054498935 - ], - "rotation_rpy_deg_xyz": [ - -0.6865945926762015, - 1.304106599014521, - -0.8334414989727543 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11803306342745587, - "median": 0.06029073752853563, - "p90": 0.19438113157937068, - "p95": 0.2394499065333869, - "max": 0.3827738195576965 - }, - "rotation_deg": { - "rms": 1.175598202053685, - "median": 0.935222175107793, - "p90": 1.7442298306900368, - "p95": 2.0810965645328032, - "max": 2.7950474936847964 - }, - "normalized_pair_score": { - "rms": 3.331793234208173, - "median": 2.523038590130543, - "p90": 4.969213940438414, - "p95": 5.737486726388554, - "max": 7.995123339790993 - }, - "normalized_global_rms": 3.331793234208173 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01889819876722937, - 0.020982258882023985, - 0.08705835448132312 - ], - "translation_xyz_cm": [ - -1.8898198767229368, - 2.0982258882023985, - 8.705835448132312 - ], - "translation_norm_m": 0.09152351713867697, - "rotation_rpy_deg_xyz": [ - 0.39648889821986194, - 0.0781526358290534, - 0.09450105751256688 - ], - "rotation_angle_deg": 0.41495850563128295, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6476453039285432, - "median": 0.7594633089830762, - "p90": 2.329487946106142, - "p95": 3.8537501645923045, - "max": 5.457199431160461 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.0059241016060888885, - "p90": 0.053409267341990724, - "p95": 0.08720196104337444, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01889819876722937, - 0.020982258882023985, - 0.08705835448132312 - ], - "translation_xyz_cm": [ - -1.8898198767229368, - 2.0982258882023985, - 8.705835448132312 - ], - "translation_norm_m": 0.09152351713867697, - "rotation_rpy_deg_xyz": [ - 0.39648889821986194, - 0.0781526358290534, - 0.09450105751256688 - ], - "rotation_angle_deg": 0.41495850563128295, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.018392041478001664, - -0.023502528157795632, - 0.17118298879971955 - ], - "translation_xyz_cm": [ - 1.8392041478001664, - -2.3502528157795632, - 17.118298879971956 - ], - "translation_norm_m": 0.1737649322330067, - "rotation_rpy_deg_xyz": [ - -0.3387845702298147, - -0.36028802329777615, - -0.3550532170358457 - ], - "rotation_angle_deg": 0.6094263353144331, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.02839076535022611, - 0.003323556244822834, - 0.15120013240993363 - ], - "translation_xyz_cm": [ - 2.839076535022611, - 0.3323556244822834, - 15.120013240993362 - ], - "translation_norm_m": 0.15387839882213997, - "rotation_rpy_deg_xyz": [ - -0.0010798022222102267, - -0.31548294000361404, - -0.39035664742627024 - ], - "rotation_angle_deg": 0.5019072618651593, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.010849026750921434, - -0.0020305734648766727, - 0.10254107139476121 - ], - "translation_xyz_cm": [ - -1.0849026750921433, - -0.20305734648766727, - 10.25410713947612 - ], - "translation_norm_m": 0.10313338903005169, - "rotation_rpy_deg_xyz": [ - 0.7246168984303567, - 0.057584780694649784, - 0.204535609134985 - ], - "rotation_angle_deg": 0.7550304026999458, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.02090950559591709, - -0.0056932435563772366, - -0.025587053055809605 - ], - "translation_xyz_cm": [ - -2.090950559591709, - -0.5693243556377237, - -2.5587053055809603 - ], - "translation_norm_m": 0.03353084744736904, - "rotation_rpy_deg_xyz": [ - 0.7687527687205982, - -0.14886878509705426, - 0.060405471443234486 - ], - "rotation_angle_deg": 0.7854373437360197, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.030499662379368297, - -0.01796717848199819, - 0.0745363869233978 - ], - "translation_xyz_cm": [ - 3.0499662379368297, - -1.7967178481998192, - 7.45363869233978 - ], - "translation_norm_m": 0.08251497975188443, - "rotation_rpy_deg_xyz": [ - 0.38815897732612226, - 0.04214235300041998, - -0.3440934468968269 - ], - "rotation_angle_deg": 0.5205203583199068, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04180428051417495, - 0.006159163266024614, - 0.06517320938073731 - ], - "translation_xyz_cm": [ - 4.180428051417495, - 0.6159163266024614, - 6.517320938073731 - ], - "translation_norm_m": 0.07767290636013822, - "rotation_rpy_deg_xyz": [ - 0.7390600202553651, - 0.3289924063597281, - -0.3605326049918974 - ], - "rotation_angle_deg": 0.8865414836551114, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0010177288011229968, - -0.0065241610625372815, - 0.0014819457043426035 - ], - "translation_xyz_cm": [ - -0.10177288011229968, - -0.6524161062537281, - 0.14819457043426035 - ], - "translation_norm_m": 0.006767319451096005, - "rotation_rpy_deg_xyz": [ - 1.1158863827102634, - 0.2263650802035911, - 0.02360230557881065 - ], - "rotation_angle_deg": 1.1388129542930738, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004626574755241736, - 0.019185200489107407, - 0.001863162574504211 - ], - "translation_xyz_cm": [ - 0.4626574755241736, - 1.9185200489107408, - 0.1863162574504211 - ], - "translation_norm_m": 0.019822928304166376, - "rotation_rpy_deg_xyz": [ - 0.3671865926499578, - 0.21180977489442965, - -0.025081078818708746 - ], - "rotation_angle_deg": 0.4246790834280009, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03979180315834657, - -0.003586899871641791, - -0.034697996210168225 - ], - "translation_xyz_cm": [ - -3.9791803158346575, - -0.3586899871641791, - -3.4697996210168225 - ], - "translation_norm_m": 0.05291695749268502, - "rotation_rpy_deg_xyz": [ - 0.8109241824507055, - 0.8435758731953724, - 0.5768857763074681 - ], - "rotation_angle_deg": 1.3019617421540421, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.05126723490732846, - -0.026784273868093345, - -0.04362760233512232 - ], - "translation_xyz_cm": [ - -5.126723490732846, - -2.6784273868093345, - -4.362760233512232 - ], - "translation_norm_m": 0.07245063413936276, - "rotation_rpy_deg_xyz": [ - 0.9375577101441926, - 1.385280458985951, - 0.4949818282277369 - ], - "rotation_angle_deg": 1.74119009685951, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03385915276645558, - -0.0208106405716163, - -0.04303099799677854 - ], - "translation_xyz_cm": [ - -3.3859152766455582, - -2.08106405716163, - -4.303099799677854 - ], - "translation_norm_m": 0.05857637557635278, - "rotation_rpy_deg_xyz": [ - 0.5920832333442769, - 0.44458884158918016, - 0.5986466857262219 - ], - "rotation_angle_deg": 0.950706339012397, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04135060583361016, - -0.04177341285877423, - -0.05159993653461947 - ], - "translation_xyz_cm": [ - -4.135060583361016, - -4.177341285877423, - -5.159993653461948 - ], - "translation_norm_m": 0.07821409128189726, - "rotation_rpy_deg_xyz": [ - 0.8475099843286586, - 0.9439519004077322, - 0.5187498254743066 - ], - "rotation_angle_deg": 1.3678995990538894, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012909969477708026, - -0.013540523316963926, - -0.009359209822525093 - ], - "translation_xyz_cm": [ - -1.2909969477708025, - -1.3540523316963926, - -0.9359209822525093 - ], - "translation_norm_m": 0.020919079619205208, - "rotation_rpy_deg_xyz": [ - 0.4247830860786736, - 0.32372007985039, - -0.08676213046108681 - ], - "rotation_angle_deg": 0.5412677005226265, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.008668985713489119, - -0.014401486216333803, - -0.1921931542269568 - ], - "translation_xyz_cm": [ - 0.8668985713489119, - -1.4401486216333803, - -19.21931542269568 - ], - "translation_norm_m": 0.19292683237498803, - "rotation_rpy_deg_xyz": [ - -0.7001065516328544, - 0.04324014704092041, - 0.33481941572538865 - ], - "rotation_angle_deg": 0.7773663334305835, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.000363328711287747, - 0.00862195846542229, - -0.2377245859694536 - ], - "translation_xyz_cm": [ - -0.0363328711287747, - 0.862195846542229, - -23.77245859694536 - ], - "translation_norm_m": 0.2378811656056024, - "rotation_rpy_deg_xyz": [ - -0.4240445906858712, - -0.26089661503771583, - 0.4343298152990177 - ], - "rotation_angle_deg": 0.6600629565864764, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.006016167793492566, - -0.0009055215328422905, - -0.02139935727056176 - ], - "translation_xyz_cm": [ - -0.6016167793492566, - -0.09055215328422905, - -2.139935727056176 - ], - "translation_norm_m": 0.02224739840428635, - "rotation_rpy_deg_xyz": [ - 0.3146390140215644, - -0.0799668518132801, - -0.09504496433455455 - ], - "rotation_angle_deg": 0.3382072941096015, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0009542296324354799, - 0.024630077162774544, - -0.2681254067622675 - ], - "translation_xyz_cm": [ - 0.09542296324354799, - 2.4630077162774544, - -26.81254067622675 - ], - "translation_norm_m": 0.26925598416129404, - "rotation_rpy_deg_xyz": [ - -0.39473793657812134, - -0.03476290507651309, - 0.07349298250880373 - ], - "rotation_angle_deg": 0.40300135095667644, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0025893631530262695, - 0.014024057584602234, - -0.16384927426212878 - ], - "translation_xyz_cm": [ - -0.25893631530262695, - 1.4024057584602234, - -16.38492742621288 - ], - "translation_norm_m": 0.16446873158415487, - "rotation_rpy_deg_xyz": [ - -0.4794009642746438, - 0.7016185469444604, - 0.2772109822385888 - ], - "rotation_angle_deg": 0.8947418027441342, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.005604204146161806, - 0.025239968497046128, - 0.00966132123188597 - ], - "translation_xyz_cm": [ - 0.5604204146161806, - 2.523996849704613, - 0.9661321231885969 - ], - "translation_norm_m": 0.027600801470055697, - "rotation_rpy_deg_xyz": [ - 0.38472775599545506, - -0.8695339533683856, - -0.24964827601765247 - ], - "rotation_angle_deg": 0.9823273930306037, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014938021847176408, - -0.02881189612753323, - -0.021358927172824144 - ], - "translation_xyz_cm": [ - -1.4938021847176408, - -2.881189612753323, - -2.1358927172824145 - ], - "translation_norm_m": 0.03885194493387029, - "rotation_rpy_deg_xyz": [ - 0.12874687504041613, - -0.37403400979925, - -0.47940827510202416 - ], - "rotation_angle_deg": 0.6212129987055194, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0040797356239348215, - 0.007140121088231033, - -0.003051743066109433 - ], - "translation_xyz_cm": [ - 0.40797356239348215, - 0.7140121088231033, - -0.3051743066109433 - ], - "translation_norm_m": 0.00877147123676247, - "rotation_rpy_deg_xyz": [ - 0.5361565462559075, - -0.6416598814032454, - -0.4819653856901528 - ], - "rotation_angle_deg": 0.9636289793832028, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.02025221774929664, - 0.009001783454693157, - -0.20739782495239578 - ], - "translation_xyz_cm": [ - -2.025221774929664, - 0.9001783454693157, - -20.739782495239577 - ], - "translation_norm_m": 0.20857862360298265, - "rotation_rpy_deg_xyz": [ - -0.4464625441595019, - 0.9578769729970588, - -0.6365510841456897 - ], - "rotation_angle_deg": 1.2317820539127526, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.02963338764615043, - 0.022171236378818016, - -0.2319015161599327 - ], - "translation_xyz_cm": [ - -2.963338764615043, - 2.2171236378818016, - -23.190151615993273 - ], - "translation_norm_m": 0.23483614411590897, - "rotation_rpy_deg_xyz": [ - 0.07402101736969303, - 0.8701986573383436, - -0.40624756303970583 - ], - "rotation_angle_deg": 0.9634393115979664, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011003965657274906, - 0.029773038417202913, - -0.03564559584788788 - ], - "translation_xyz_cm": [ - 1.1003965657274906, - 2.9773038417202913, - -3.564559584788788 - ], - "translation_norm_m": 0.04772975570993097, - "rotation_rpy_deg_xyz": [ - 0.375947360340056, - -0.13333849894651065, - -0.011787422082148637 - ], - "rotation_angle_deg": 0.3990540554431745, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.011656018917842514, - 0.043432122225597114, - -0.13618938071863945 - ], - "translation_xyz_cm": [ - 1.1656018917842514, - 4.343212222559711, - -13.618938071863946 - ], - "translation_norm_m": 0.14342161426562886, - "rotation_rpy_deg_xyz": [ - -0.4688260545863984, - -0.3136470052105622, - 0.16398359805059556 - ], - "rotation_angle_deg": 0.5870615934185616, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005244325053297583, - 0.017950769804155775, - -0.0869848423712509 - ], - "translation_xyz_cm": [ - 0.5244325053297583, - 1.7950769804155775, - -8.69848423712509 - ], - "translation_norm_m": 0.08897244452176079, - "rotation_rpy_deg_xyz": [ - -0.7182948884300802, - -0.16491908844219316, - 0.16250473383877287 - ], - "rotation_angle_deg": 0.7544646697106224, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.011095967392524386, - -0.026382941292792506, - -0.16655538662389305 - ], - "translation_xyz_cm": [ - -1.1095967392524386, - -2.6382941292792506, - -16.655538662389304 - ], - "translation_norm_m": 0.16899667717759836, - "rotation_rpy_deg_xyz": [ - -0.7696735250409878, - 2.2211302577545093, - -0.3714295375389216 - ], - "rotation_angle_deg": 2.3775199058039163, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.0034490058615741503, - 0.02015001355982926, - -0.021216078978998174 - ], - "translation_xyz_cm": [ - 0.34490058615741503, - 2.015001355982926, - -2.121607897899817 - ], - "translation_norm_m": 0.029462530358704157, - "rotation_rpy_deg_xyz": [ - 1.0429857214645997, - 0.06429739584305978, - 0.21919092926637623 - ], - "rotation_angle_deg": 1.0675860799197308, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.006487721942835867, - 0.035094894134471755, - 0.0572543135918914 - ], - "translation_xyz_cm": [ - 0.6487721942835867, - 3.5094894134471755, - 5.72543135918914 - ], - "translation_norm_m": 0.0674670182770513, - "rotation_rpy_deg_xyz": [ - 1.2369231598354689, - 1.5254976746157236, - 0.15478499999354337 - ], - "rotation_angle_deg": 1.9687280632276194, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.014134689421850144, - 0.001336741363490379, - -0.026059170737751672 - ], - "translation_xyz_cm": [ - -1.4134689421850144, - 0.1336741363490379, - -2.605917073775167 - ], - "translation_norm_m": 0.029675860595176032, - "rotation_rpy_deg_xyz": [ - 0.13252374852628734, - 2.3578000349595594, - 0.6947420905734338 - ], - "rotation_angle_deg": 2.4608109460079435, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.009253702061698177, - -0.0032914560258030523, - 0.3826477913880747 - ], - "translation_xyz_cm": [ - 0.9253702061698177, - -0.32914560258030523, - 38.26477913880747 - ], - "translation_norm_m": 0.3827738195576965, - "rotation_rpy_deg_xyz": [ - -0.9924637994643686, - 0.5840048829745171, - -0.0589814831812137 - ], - "rotation_angle_deg": 1.1527877561541284, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010537498914390264, - 0.0363976072608343, - 0.047331638114804384 - ], - "translation_xyz_cm": [ - 1.0537498914390264, - 3.6397607260834297, - 4.733163811480439 - ], - "translation_norm_m": 0.06063092168452923, - "rotation_rpy_deg_xyz": [ - 1.4610064611135007, - -0.40205252975501715, - 0.05645786134216361 - ], - "rotation_angle_deg": 1.5165564521207573, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.007951814945897473, - 0.01397569331655757, - 0.0050783252002833115 - ], - "translation_xyz_cm": [ - -0.7951814945897473, - 1.397569331655757, - 0.5078325200283311 - ], - "translation_norm_m": 0.016862406454954845, - "rotation_rpy_deg_xyz": [ - 0.30696202798823863, - 1.984286842136994, - 0.4897875393745815 - ], - "rotation_angle_deg": 2.065495336044851, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.028721797634823187, - 0.01994331454877951, - 0.14645837033814033 - ], - "translation_xyz_cm": [ - 2.8721797634823187, - 1.9943314548779512, - 14.645837033814033 - ], - "translation_norm_m": 0.15057467149780257, - "rotation_rpy_deg_xyz": [ - 0.20210964542179843, - -0.8422061387224561, - -0.29352121246309015 - ], - "rotation_angle_deg": 0.9140239620705453, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.00487167588674324, - 0.005686805439648612, - 0.3812068891800616 - ], - "translation_xyz_cm": [ - 0.487167588674324, - 0.5686805439648612, - 38.12068891800616 - ], - "translation_norm_m": 0.38128042874030876, - "rotation_rpy_deg_xyz": [ - -0.3019631188813741, - 0.5010484241561677, - -0.23933974317696882 - ], - "rotation_angle_deg": 0.6315707955287407, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01749551169431074, - 0.009410598460922459, - 0.06028121999378366 - ], - "translation_xyz_cm": [ - -1.749551169431074, - 0.9410598460922459, - 6.028121999378366 - ], - "translation_norm_m": 0.06347029050490807, - "rotation_rpy_deg_xyz": [ - 1.047392816105556, - 2.5276627828726066, - 0.5949063357968501 - ], - "rotation_angle_deg": 2.7950474936847964, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03093951134652151, - 0.00016365812436869298, - 0.18226432689960714 - ], - "translation_xyz_cm": [ - 3.093951134652151, - 0.016365812436869298, - 18.226432689960713 - ], - "translation_norm_m": 0.1848717528626536, - "rotation_rpy_deg_xyz": [ - 0.48810144394194516, - -0.30356589081468527, - -0.2223627214780615 - ], - "rotation_angle_deg": 0.6158444866752828, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03476337368150295, - 0.0059586549928045685, - 0.3106028418696867 - ], - "translation_xyz_cm": [ - 3.476337368150295, - 0.5958654992804568, - 31.060284186968666 - ], - "translation_norm_m": 0.31259898127884017, - "rotation_rpy_deg_xyz": [ - 0.35034222469226833, - -0.013305552483010694, - -0.23313303614260156 - ], - "rotation_angle_deg": 0.4210090108121208, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.02620167696551734, - 0.018812692176798373, - 0.07215684151330468 - ], - "translation_xyz_cm": [ - 2.620167696551734, - 1.8812692176798373, - 7.215684151330468 - ], - "translation_norm_m": 0.07903831374669162, - "rotation_rpy_deg_xyz": [ - 0.9389024381931859, - -2.420086954876392, - -0.793150863489167 - ], - "rotation_angle_deg": 2.7084596451497114, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013810661101449906, - 0.02473652956106598, - 0.20552639195390102 - ], - "translation_xyz_cm": [ - -1.3810661101449906, - 2.473652956106598, - 20.552639195390103 - ], - "translation_norm_m": 0.20746982441881312, - "rotation_rpy_deg_xyz": [ - 0.7789990026512972, - -0.8027447645658545, - -0.7350854540759948 - ], - "rotation_angle_deg": 1.3354921460048128, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0038000729057454663, - -0.021036507466261956, - 0.16495495420126316 - ], - "translation_xyz_cm": [ - -0.38000729057454663, - -2.1036507466261956, - 16.495495420126318 - ], - "translation_norm_m": 0.16633433835503691, - "rotation_rpy_deg_xyz": [ - -0.9940399359641277, - 0.4688586153488577, - -0.024856910685555723 - ], - "rotation_angle_deg": 1.0992515333647757, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0030560528430260137, - -0.009267951060966784, - -0.05337103508823181 - ], - "translation_xyz_cm": [ - 0.30560528430260137, - -0.9267951060966784, - -5.337103508823181 - ], - "translation_norm_m": 0.05425589149794807, - "rotation_rpy_deg_xyz": [ - -0.345079184425983, - 0.31453503723949827, - 0.08876343415225706 - ], - "rotation_angle_deg": 0.4754562952407481, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.00042052503555867204, - 0.027382541574402675, - 0.060893006947838745 - ], - "translation_xyz_cm": [ - -0.042052503555867204, - 2.7382541574402675, - 6.089300694783875 - ], - "translation_norm_m": 0.06676779702468069, - "rotation_rpy_deg_xyz": [ - -0.751948054189981, - -0.04773236022911271, - -0.7162585446896282 - ], - "rotation_angle_deg": 1.0397941252280043, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.011814364839580982, - -0.04501862262220668, - 0.0016649071399539774 - ], - "translation_xyz_cm": [ - 1.1814364839580982, - -4.501862262220668, - 0.16649071399539775 - ], - "translation_norm_m": 0.04657281948892569, - "rotation_rpy_deg_xyz": [ - 0.24320996876120976, - 0.15361592262504456, - -0.6279553712641661 - ], - "rotation_angle_deg": 0.691003253764116, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.015083044785085598, - -0.01832285225467567, - 0.012914549954595102 - ], - "translation_xyz_cm": [ - -1.5083044785085598, - -1.832285225467567, - 1.2914549954595103 - ], - "translation_norm_m": 0.02701871120659354, - "rotation_rpy_deg_xyz": [ - 0.5820423182238987, - -0.13224067095655326, - -0.7004303542911477 - ], - "rotation_angle_deg": 0.9197380112031891, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.009677303635209356, - 0.020474539151358995, - -0.053341743698745746 - ], - "translation_xyz_cm": [ - 0.9677303635209356, - 2.0474539151358995, - -5.3341743698745745 - ], - "translation_norm_m": 0.057949966177136374, - "rotation_rpy_deg_xyz": [ - 0.563858322786623, - 0.0733022179734362, - 0.14174703110334208 - ], - "rotation_angle_deg": 0.5859173852459124, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.012726972225321431, - 0.002630433417061706, - 0.01603518684435226 - ], - "translation_xyz_cm": [ - 1.2726972225321431, - 0.2630433417061706, - 1.603518684435226 - ], - "translation_norm_m": 0.020640305693448095, - "rotation_rpy_deg_xyz": [ - 1.164747376634215, - 0.9640802202358213, - 0.026842662491847656 - ], - "rotation_angle_deg": 1.5120348954863982, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.003470547418826797, - -0.017855280965434428, - -0.011932545005758993 - ], - "translation_xyz_cm": [ - 0.3470547418826797, - -1.7855280965434428, - -1.1932545005758994 - ], - "translation_norm_m": 0.02175411198039107, - "rotation_rpy_deg_xyz": [ - -1.329676337675729, - -1.1626823332197151, - 0.15095826935653922 - ], - "rotation_angle_deg": 1.7715874351647753, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.009679420493060586, - -0.0003158638950594428, - 0.024922635741388796 - ], - "translation_xyz_cm": [ - 0.9679420493060586, - -0.03158638950594428, - 2.4922635741388794 - ], - "translation_norm_m": 0.026738151083790997, - "rotation_rpy_deg_xyz": [ - -0.20494052495206053, - -0.8039904422568303, - -0.1300973769100517 - ], - "rotation_angle_deg": 0.8400593576356165, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0007926005560916494, - -0.03151612523557562, - 0.03239260577929862 - ], - "translation_xyz_cm": [ - 0.07926005560916494, - -3.151612523557562, - 3.2392605779298616 - ], - "translation_norm_m": 0.04520149637654768, - "rotation_rpy_deg_xyz": [ - 1.5559043933966612, - -0.11857189590280649, - -0.19510174289811608 - ], - "rotation_angle_deg": 1.5723647927880093, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0012217136671263673, - 0.015265647454538733, - -0.06687251609922523 - ], - "translation_xyz_cm": [ - 0.12217136671263673, - 1.5265647454538733, - -6.687251609922523 - ], - "translation_norm_m": 0.06860368784498284, - "rotation_rpy_deg_xyz": [ - 0.5088792321992115, - 1.6374487610821793, - 0.10138804920613424 - ], - "rotation_angle_deg": 1.7172603633907186, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.010438552147981728, - 0.023508446854636045, - 0.04992032081575569 - ], - "translation_xyz_cm": [ - -1.0438552147981728, - 2.3508446854636045, - 4.9920320815755685 - ], - "translation_norm_m": 0.056157358153774935, - "rotation_rpy_deg_xyz": [ - 0.47598301094761664, - 0.8524813540393087, - -0.27868873583753434 - ], - "rotation_angle_deg": 1.0163263756098806, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.002072771904091386, - -0.03761147095552231, - -0.053225200004716644 - ], - "translation_xyz_cm": [ - -0.2072771904091386, - -3.761147095552231, - -5.322520000471664 - ], - "translation_norm_m": 0.06520614270409328, - "rotation_rpy_deg_xyz": [ - 0.3209995294490652, - 0.3119522111056677, - -0.09455072391620137 - ], - "rotation_angle_deg": 0.45766763783887143, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0009955306755837778, - 0.029820260715713864, - -0.04139235390858216 - ], - "translation_xyz_cm": [ - 0.09955306755837778, - 2.9820260715713864, - -4.139235390858216 - ], - "translation_norm_m": 0.051025150588435236, - "rotation_rpy_deg_xyz": [ - 0.25840083694567817, - 1.2490182641596292, - 0.22179912764965037 - ], - "rotation_angle_deg": 1.2941245683971774, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017717513747474545, - 0.01128163534888671, - -0.07150690483471722 - ], - "translation_xyz_cm": [ - -1.7717513747474545, - 1.128163534888671, - -7.150690483471722 - ], - "translation_norm_m": 0.07452800164084976, - "rotation_rpy_deg_xyz": [ - 0.5943675840979633, - 0.18831638378959084, - 0.36494684078415984 - ], - "rotation_angle_deg": 0.7219470301184151, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.028064674724201488, - 0.013932298050942427, - -0.07213682925781545 - ], - "translation_xyz_cm": [ - -2.806467472420149, - 1.3932298050942427, - -7.213682925781545 - ], - "translation_norm_m": 0.07864767658187206, - "rotation_rpy_deg_xyz": [ - 0.1002211764532638, - 0.28340151801846314, - 0.07287046460555184 - ], - "rotation_angle_deg": 0.3092485295282774, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.0331759344926954, - 0.01989699539281431, - -0.05044408009827264 - ], - "translation_xyz_cm": [ - -3.3175934492695403, - 1.989699539281431, - -5.044408009827264 - ], - "translation_norm_m": 0.06356994786914834, - "rotation_rpy_deg_xyz": [ - 0.5651265372044327, - 0.43303503435282964, - 0.318720183800406 - ], - "rotation_angle_deg": 0.7791699214902091, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007714252392278409, - -0.014884937385618136, - -0.058693818988563656 - ], - "translation_xyz_cm": [ - -0.7714252392278409, - -1.4884937385618136, - -5.869381898856366 - ], - "translation_norm_m": 0.06104126013122453, - "rotation_rpy_deg_xyz": [ - 1.3384875723294563, - 0.6884558982073876, - 0.5007165378822055 - ], - "rotation_angle_deg": 1.583713529671515, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.019232144185684197, - -0.021756691790354, - -0.020095460607639594 - ], - "translation_xyz_cm": [ - 1.9232144185684197, - -2.1756691790354, - -2.0095460607639595 - ], - "translation_norm_m": 0.035313687780697704, - "rotation_rpy_deg_xyz": [ - 0.10781505187077589, - -0.03991782290829695, - -0.22702370066587177 - ], - "rotation_angle_deg": 0.25444097180203507, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.009449556316452556, - -0.0005617308667847931, - -0.03999703772863817 - ], - "translation_xyz_cm": [ - -0.9449556316452556, - -0.05617308667847931, - -3.999703772863817 - ], - "translation_norm_m": 0.04110197906683585, - "rotation_rpy_deg_xyz": [ - 0.7644985655501492, - 0.3163505678377733, - 0.26412838386060333 - ], - "rotation_angle_deg": 0.8678605532760487, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0012381855913607964, - -0.0022633340745339403, - 0.051129715797312666 - ], - "translation_xyz_cm": [ - -0.12381855913607964, - -0.22633340745339403, - 5.1129715797312665 - ], - "translation_norm_m": 0.05119476166763123, - "rotation_rpy_deg_xyz": [ - 1.3975184754426657, - -0.4786574930277841, - -0.2824956902890395 - ], - "rotation_angle_deg": 1.5028841475601042, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.014307275841931588, - 0.005512174984535045, - 0.01672647013441611 - ], - "translation_xyz_cm": [ - -1.4307275841931588, - 0.5512174984535045, - 1.672647013441611 - ], - "translation_norm_m": 0.022690460952452404, - "rotation_rpy_deg_xyz": [ - 1.4095461835453473, - 0.5140940210440624, - 0.42444135680291695 - ], - "rotation_angle_deg": 1.5575210729303852, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.007198787245712435, - -0.009298012911912679, - -0.022703496864277584 - ], - "translation_xyz_cm": [ - -0.7198787245712435, - -0.9298012911912679, - -2.2703496864277586 - ], - "translation_norm_m": 0.025568033788021107, - "rotation_rpy_deg_xyz": [ - -0.042703598230177275, - 0.6411308959381461, - -0.2895477959524691 - ], - "rotation_angle_deg": 0.7046780059125723, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.00563738270834202, - 0.014466619546402715, - 0.12854164833963927 - ], - "translation_xyz_cm": [ - 0.563738270834202, - 1.4466619546402715, - 12.854164833963926 - ], - "translation_norm_m": 0.12947593800692142, - "rotation_rpy_deg_xyz": [ - 1.8389120110441317, - -0.3837588422991987, - -0.5009065716223591 - ], - "rotation_angle_deg": 1.9425681350101711, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0006533780620823215, - 0.0012577526571795339, - 0.08453788815638572 - ], - "translation_xyz_cm": [ - 0.06533780620823215, - 0.1257752657179534, - 8.453788815638571 - ], - "translation_norm_m": 0.08454976864888651, - "rotation_rpy_deg_xyz": [ - 1.413282794355114, - 0.1324330991614068, - 0.18318097653160254 - ], - "rotation_angle_deg": 1.4310349606215507, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.007292694940098432, - 0.0076625271666668215, - 0.0316804871179871 - ], - "translation_xyz_cm": [ - 0.7292694940098432, - 0.7662527166666822, - 3.16804871179871 - ], - "translation_norm_m": 0.033399865061137464, - "rotation_rpy_deg_xyz": [ - 1.089828229873966, - 0.9204247175463454, - -0.5030109712632563 - ], - "rotation_angle_deg": 1.5154851077449842, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006041695127878555, - 0.04182564269482847, - 0.07443084525058304 - ], - "translation_xyz_cm": [ - -0.6041695127878555, - 4.182564269482847, - 7.443084525058303 - ], - "translation_norm_m": 0.08559110462875175, - "rotation_rpy_deg_xyz": [ - -1.1937649702057012, - -0.2422285850667012, - 0.6246771213266397 - ], - "rotation_angle_deg": 1.367772465297337, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02522681722918474, - 0.024125721130114464, - 0.04874039517803756 - ], - "translation_xyz_cm": [ - 2.522681722918474, - 2.4125721130114464, - 4.874039517803756 - ], - "translation_norm_m": 0.05995055337254203, - "rotation_rpy_deg_xyz": [ - -0.3416942077159347, - 0.06981132513036926, - 0.5092466774927584 - ], - "rotation_angle_deg": 0.6173912311611599, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0037996856911726162, - -0.03153183600902515, - 0.004632910412513971 - ], - "translation_xyz_cm": [ - -0.3799685691172616, - -3.1531836009025147, - 0.46329104125139714 - ], - "translation_norm_m": 0.032096076899554835, - "rotation_rpy_deg_xyz": [ - 0.2255505034309943, - -0.44748924021654984, - -0.11785617150213648 - ], - "rotation_angle_deg": 0.5145889291314739, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.025164980551425797, - 0.029644303445291786, - -0.0559249843689818 - ], - "translation_xyz_cm": [ - -2.5164980551425797, - 2.9644303445291786, - -5.59249843689818 - ], - "translation_norm_m": 0.06811508533049809, - "rotation_rpy_deg_xyz": [ - -0.8022495198384715, - -0.6625117765659508, - -0.05221275290566554 - ], - "rotation_angle_deg": 1.0419834064160636, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.007333419765788385, - 0.03856115151287276, - -0.010890965293976151 - ], - "translation_xyz_cm": [ - 0.7333419765788385, - 3.856115151287276, - -1.0890965293976151 - ], - "translation_norm_m": 0.04073517615642012, - "rotation_rpy_deg_xyz": [ - -0.36506499088289296, - -0.27470148631380453, - -0.06970249929823949 - ], - "rotation_angle_deg": 0.46229158623749345, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.0008609135525388112, - -0.0077378483750044635, - 0.027097056775274977 - ], - "translation_xyz_cm": [ - 0.08609135525388112, - -0.7737848375004464, - 2.7097056775274977 - ], - "translation_norm_m": 0.02819336722532411, - "rotation_rpy_deg_xyz": [ - 0.41613838746902954, - -1.0040169846561846, - 0.23732919183234044 - ], - "rotation_angle_deg": 1.1132254626025933, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016414573230911333, - 0.00264272771402152, - 0.033960308038094834 - ], - "translation_xyz_cm": [ - -1.6414573230911333, - 0.264272771402152, - 3.3960308038094835 - ], - "translation_norm_m": 0.037811701180530045, - "rotation_rpy_deg_xyz": [ - -0.4750491933992374, - -0.8681867717502193, - 0.1780643632417989 - ], - "rotation_angle_deg": 1.0049079856953842, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0037359066407804953, - 0.020046515512025964, - -0.03715972765525523 - ], - "translation_xyz_cm": [ - 0.37359066407804953, - 2.0046515512025964, - -3.715972765525523 - ], - "translation_norm_m": 0.04238708697251164, - "rotation_rpy_deg_xyz": [ - 0.3241219139329225, - -0.12013693080105337, - 0.11150723160586556 - ], - "rotation_angle_deg": 0.36331455462514856, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01439415962415902, - 0.018346315538520286, - -0.07627364622412787 - ], - "translation_xyz_cm": [ - 1.439415962415902, - 1.8346315538520286, - -7.627364622412787 - ], - "translation_norm_m": 0.07975868751081688, - "rotation_rpy_deg_xyz": [ - 1.2183796736685228, - -0.12770295406939952, - 0.11087280801681915 - ], - "rotation_angle_deg": 1.2301828535786548, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.007851200838448591, - 0.0013477746413406155, - -0.010118237127062064 - ], - "translation_xyz_cm": [ - -0.7851200838448591, - 0.13477746413406155, - -1.0118237127062064 - ], - "translation_norm_m": 0.01287775499258135, - "rotation_rpy_deg_xyz": [ - 0.27260419657730517, - 0.015585516670647056, - -0.04743443943434178 - ], - "rotation_angle_deg": 0.2771452598811445, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.018293277874859015, - 0.02635757468987676, - -0.0468293043727875 - ], - "translation_xyz_cm": [ - 1.8293277874859015, - 2.635757468987676, - -4.68293043727875 - ], - "translation_norm_m": 0.05676574237141987, - "rotation_rpy_deg_xyz": [ - 0.8405259550474138, - 0.4919911131614944, - -0.1327373068453575 - ], - "rotation_angle_deg": 0.9834183205157861, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.02360149964854985, - 0.023231905686199372, - 0.027798611322039014 - ], - "translation_xyz_cm": [ - 2.360149964854985, - 2.3231905686199372, - 2.7798611322039015 - ], - "translation_norm_m": 0.043237888696220556, - "rotation_rpy_deg_xyz": [ - 1.0299806341792144, - 0.4344132038431418, - -0.08017118761934525 - ], - "rotation_angle_deg": 1.1209920378191442, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00016695419154655333, - -0.0017412109488013083, - 0.01221454505984091 - ], - "translation_xyz_cm": [ - -0.016695419154655333, - -0.17412109488013083, - 1.221454505984091 - ], - "translation_norm_m": 0.012339157195253836, - "rotation_rpy_deg_xyz": [ - 0.6946245746071652, - 0.002691251615110187, - 0.009518619196162807 - ], - "rotation_angle_deg": 0.6946947781789068, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.035557616983437956, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.021922643950929743, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.300266778135581, - 0.0024476764333135033, - 0.7159592638351174 - ], - "rotation_rpy_deg_xyz": [ - -0.9881056123574021, - 1.3997156446701597, - -0.8397697014302278 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.12062476910644687, - "median": 0.06360834751170838, - "p90": 0.19266359126571, - "p95": 0.2374895093805351, - "max": 0.39293270189987173 - }, - "rotation_deg": { - "rms": 1.2178088730560497, - "median": 0.9727452319073359, - "p90": 1.7081277277767946, - "p95": 2.445810125961962, - "max": 3.0871688650699287 - }, - "normalized_pair_score": { - "rms": 3.428172658132847, - "median": 2.4571166315934985, - "p90": 5.315128734910726, - "p95": 6.243836876942271, - "max": 8.60172031997773 - }, - "normalized_global_rms": 3.428172658132847 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.017975490167216, - 0.020446575946191592, - 0.08402747312858636 - ], - "translation_xyz_cm": [ - -1.7975490167216002, - 2.044657594619159, - 8.402747312858635 - ], - "translation_norm_m": 0.08832778133209483, - "rotation_rpy_deg_xyz": [ - 0.4103564642355542, - 0.1494767277354066, - 0.0963731229536819 - ], - "rotation_angle_deg": 0.4471243504044202, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7067898021773054, - "median": 0.7385055841034844, - "p90": 2.354962484664117, - "p95": 3.858143262184229, - "max": 5.772844678665988 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337456, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.017975490167216, - 0.020446575946191592, - 0.08402747312858636 - ], - "translation_xyz_cm": [ - -1.7975490167216002, - 2.044657594619159, - 8.402747312858635 - ], - "translation_norm_m": 0.08832778133209483, - "rotation_rpy_deg_xyz": [ - 0.4103564642355542, - 0.1494767277354066, - 0.0963731229536819 - ], - "rotation_angle_deg": 0.4471243504044202, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.020422117792211925, - -0.024302559851938632, - 0.16640457058359376 - ], - "translation_xyz_cm": [ - 2.0422117792211925, - -2.430255985193863, - 16.640457058359377 - ], - "translation_norm_m": 0.16940530812694823, - "rotation_rpy_deg_xyz": [ - -0.3276406277784189, - -0.21681125719412686, - -0.3535275552970452 - ], - "rotation_angle_deg": 0.5289375441282178, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.031655774595928055, - 0.0028880612934529815, - 0.14536649048159042 - ], - "translation_xyz_cm": [ - 3.1655774595928055, - 0.28880612934529815, - 14.536649048159042 - ], - "translation_norm_m": 0.14880136262224639, - "rotation_rpy_deg_xyz": [ - -0.013947659148935898, - -0.09055197704518776, - -0.387402117432348 - ], - "rotation_angle_deg": 0.39809936691066544, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.005958959112733676, - -0.0007476966622641523, - 0.09669655442148059 - ], - "translation_xyz_cm": [ - -0.5958959112733676, - -0.07476966622641523, - 9.66965544214806 - ], - "translation_norm_m": 0.09688287713002927, - "rotation_rpy_deg_xyz": [ - 0.6120962047983233, - 0.4067878646685525, - 0.2110576495068278 - ], - "rotation_angle_deg": 0.7640445492198845, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.015400003041581178, - -0.0031186593481193903, - -0.032015503034226914 - ], - "translation_xyz_cm": [ - -1.5400003041581178, - -0.311865934811939, - -3.2015503034226915 - ], - "translation_norm_m": 0.035663406516272596, - "rotation_rpy_deg_xyz": [ - 0.566813644600756, - 0.2469183208438338, - 0.06603752370165404 - ], - "rotation_angle_deg": 0.6216473837208485, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03141877729342202, - -0.01835576142951334, - 0.0719240492221651 - ], - "translation_xyz_cm": [ - 3.1418777293422018, - -1.835576142951334, - 7.192404922216509 - ], - "translation_norm_m": 0.0806048534567447, - "rotation_rpy_deg_xyz": [ - 0.40198668799620496, - 0.11296967141440896, - -0.3422433828167727 - ], - "rotation_angle_deg": 0.5401450420297549, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04386721070919719, - 0.005851353466003628, - 0.061399799956949865 - ], - "translation_xyz_cm": [ - 4.3867210709197195, - 0.5851353466003628, - 6.139979995694986 - ], - "translation_norm_m": 0.07568689415970692, - "rotation_rpy_deg_xyz": [ - 0.7481375948505752, - 0.48457496682095663, - -0.3560249036817612 - ], - "rotation_angle_deg": 0.9610011874334174, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.003635642741003281, - -0.004649168368721535, - -0.003407712725579201 - ], - "translation_xyz_cm": [ - 0.3635642741003281, - -0.46491683687215346, - -0.3407712725579201 - ], - "translation_norm_m": 0.006815069381965611, - "rotation_rpy_deg_xyz": [ - 0.9799008319396855, - 0.5914407982715378, - 0.03240674175630124 - ], - "rotation_angle_deg": 1.1448675452003465, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005697358598846309, - 0.019004282225829117, - 0.0006792501172214875 - ], - "translation_xyz_cm": [ - 0.5697358598846309, - 1.9004282225829117, - 0.06792501172214875 - ], - "translation_norm_m": 0.01985154952754464, - "rotation_rpy_deg_xyz": [ - 0.3817662609368116, - 0.2954555995750519, - -0.0229677264613257 - ], - "rotation_angle_deg": 0.4833341442068996, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03687094848540228, - -0.003081397292348298, - -0.036467622569219496 - ], - "translation_xyz_cm": [ - -3.687094848540228, - -0.3081397292348298, - -3.6467622569219498 - ], - "translation_norm_m": 0.051950450886758696, - "rotation_rpy_deg_xyz": [ - 0.791308535154335, - 1.082785315606241, - 0.5832634662671083 - ], - "rotation_angle_deg": 1.459463276059786, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04746061076941829, - -0.025475534926924337, - -0.04648616889401658 - ], - "translation_xyz_cm": [ - -4.746061076941829, - -2.5475534926924337, - -4.648616889401658 - ], - "translation_norm_m": 0.07115108117844872, - "rotation_rpy_deg_xyz": [ - 0.8585294831133579, - 1.7058371743302325, - 0.5028258606087064 - ], - "rotation_angle_deg": 1.971511305713397, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03189444754831497, - -0.02065529653581863, - -0.04387018508738218 - ], - "translation_xyz_cm": [ - -3.189444754831497, - -2.065529653581863, - -4.387018508738218 - ], - "translation_norm_m": 0.058038695703780126, - "rotation_rpy_deg_xyz": [ - 0.6004717193357023, - 0.6036729196392864, - 0.602825333313235 - ], - "rotation_angle_deg": 1.0414229655406162, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03831561171862389, - -0.04108096412284562, - -0.05367198830163876 - ], - "translation_xyz_cm": [ - -3.831561171862389, - -4.108096412284562, - -5.3671988301638756 - ], - "translation_norm_m": 0.07769436300585857, - "rotation_rpy_deg_xyz": [ - 0.8202618373115558, - 1.197265311905129, - 0.5254955726857641 - ], - "rotation_angle_deg": 1.5405754990600105, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.011638946587809139, - -0.013621931696123496, - -0.01061876501541497 - ], - "translation_xyz_cm": [ - -1.1638946587809138, - -1.3621931696123495, - -1.061876501541497 - ], - "translation_norm_m": 0.020827392329822014, - "rotation_rpy_deg_xyz": [ - 0.43956869075095467, - 0.4234090655589219, - -0.08420424179944198 - ], - "rotation_angle_deg": 0.6163268649194488, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012165644577491419, - -0.012069281688667041, - -0.1906652916371628 - ], - "translation_xyz_cm": [ - 1.216564457749142, - -1.2069281688667042, - -19.066529163716282 - ], - "translation_norm_m": 0.19143386300116963, - "rotation_rpy_deg_xyz": [ - -0.8320144785875967, - 0.4058203018917604, - 0.33215777636665644 - ], - "rotation_angle_deg": 0.9844892763812543, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.002575086668383908, - 0.010224284572965335, - -0.23557579522130703 - ], - "translation_xyz_cm": [ - 0.2575086668383908, - 1.0224284572965334, - -23.557579522130702 - ], - "translation_norm_m": 0.23581162473578324, - "rotation_rpy_deg_xyz": [ - -0.4805585121352401, - 0.03477512048610195, - 0.43498314066349647 - ], - "rotation_angle_deg": 0.6492163544112083, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0017544580200308246, - 0.001737084150777446, - -0.0248356061799775 - ], - "translation_xyz_cm": [ - -0.17544580200308246, - 0.1737084150777446, - -2.48356061799775 - ], - "translation_norm_m": 0.024958023131207114, - "rotation_rpy_deg_xyz": [ - 0.13133321554197633, - 0.3090158343532093, - -0.09217234056616168 - ], - "rotation_angle_deg": 0.34828172736524177, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004637507975946739, - 0.028758646551146683, - -0.26778958726809005 - ], - "translation_xyz_cm": [ - 0.4637507975946739, - 2.8758646551146683, - -26.778958726809005 - ], - "translation_norm_m": 0.26936931763082217, - "rotation_rpy_deg_xyz": [ - -0.7373798847856676, - 0.3743991186852907, - 0.06734443066266267 - ], - "rotation_angle_deg": 0.8299165899495599, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0009806830276577472, - 0.01463595571561449, - -0.1681099743491652 - ], - "translation_xyz_cm": [ - -0.09806830276577472, - 1.463595571561449, - -16.81099743491652 - ], - "translation_norm_m": 0.16874873751998012, - "rotation_rpy_deg_xyz": [ - -0.4667402647664813, - 0.8340429428045748, - 0.27835146153396695 - ], - "rotation_angle_deg": 0.9964131599153896, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.009175163951701482, - 0.026225706484181543, - 0.0020026163157599863 - ], - "translation_xyz_cm": [ - 0.9175163951701482, - 2.6225706484181543, - 0.20026163157599863 - ], - "translation_norm_m": 0.02785644963456744, - "rotation_rpy_deg_xyz": [ - 0.34063939533563414, - -0.5902497115620837, - -0.24483682391761813 - ], - "rotation_angle_deg": 0.7235427256795268, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.01286114207487321, - -0.029293853194005473, - -0.02247775147909155 - ], - "translation_xyz_cm": [ - -1.286114207487321, - -2.9293853194005472, - -2.247775147909155 - ], - "translation_norm_m": 0.03909972022889449, - "rotation_rpy_deg_xyz": [ - 0.13747140649541967, - -0.21684934976149678, - -0.476539367903237 - ], - "rotation_angle_deg": 0.5410762004110474, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.007025841212274009, - 0.0073532958363214385, - -0.00589317540601687 - ], - "translation_xyz_cm": [ - 0.7025841212274009, - 0.7353295836321438, - -0.589317540601687 - ], - "translation_norm_m": 0.01175427244718414, - "rotation_rpy_deg_xyz": [ - 0.5223034177442892, - -0.41466953813252566, - -0.47687605355499746 - ], - "rotation_angle_deg": 0.8187527483650913, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01630535858200266, - 0.012154457870331203, - -0.2069490460610031 - ], - "translation_xyz_cm": [ - -1.630535858200266, - 1.2154457870331203, - -20.69490460610031 - ], - "translation_norm_m": 0.20794591419445713, - "rotation_rpy_deg_xyz": [ - -0.679874925061202, - 1.3623319360942867, - -0.6401231556012147 - ], - "rotation_angle_deg": 1.6484969115533736, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.025816838118333886, - 0.026264833251552044, - -0.22897178936175594 - ], - "translation_xyz_cm": [ - -2.5816838118333885, - 2.6264833251552044, - -22.897178936175592 - ], - "translation_norm_m": 0.23191470613069026, - "rotation_rpy_deg_xyz": [ - -0.27017293089689287, - 1.27919416148567, - -0.409092876885814 - ], - "rotation_angle_deg": 1.3690179645976321, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01200498658643262, - 0.030035690083347055, - -0.03857303067146275 - ], - "translation_xyz_cm": [ - 1.200498658643262, - 3.0035690083347055, - -3.8573030671462747 - ], - "translation_norm_m": 0.05034025304768447, - "rotation_rpy_deg_xyz": [ - 0.3898616338500576, - -0.06130692791309602, - -0.009924579053608022 - ], - "rotation_angle_deg": 0.39477205479789074, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013690474091538118, - 0.04405527132079201, - -0.14256667263953 - ], - "translation_xyz_cm": [ - 1.3690474091538118, - 4.405527132079201, - -14.256667263952998 - ], - "translation_norm_m": 0.14984509387866718, - "rotation_rpy_deg_xyz": [ - -0.4607466558756248, - -0.15322971253549017, - 0.16521751639656126 - ], - "rotation_angle_deg": 0.5126985292354073, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006442387385156345, - 0.018095729376959357, - -0.09094246193980493 - ], - "translation_xyz_cm": [ - 0.6442387385156345, - 1.8095729376959357, - -9.094246193980492 - ], - "translation_norm_m": 0.09294886314838627, - "rotation_rpy_deg_xyz": [ - -0.7036086891632302, - -0.0775877416576009, - 0.1630440080740759 - ], - "rotation_angle_deg": 0.7263006482131844, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.00903576262201966, - -0.025527187367969884, - -0.17555673634296018 - ], - "translation_xyz_cm": [ - -0.9035762622019661, - -2.5527187367969884, - -17.555673634296017 - ], - "translation_norm_m": 0.17763290792100592, - "rotation_rpy_deg_xyz": [ - -0.7726766871415702, - 2.421367401553578, - -0.3712691752639122 - ], - "rotation_angle_deg": 2.5662531605955463, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.004921228589130355, - 0.020284695688123078, - -0.026281143260911417 - ], - "translation_xyz_cm": [ - 0.49212285891303553, - 2.0284695688123078, - -2.6281143260911417 - ], - "translation_norm_m": 0.03356167250133376, - "rotation_rpy_deg_xyz": [ - 1.0574633219641378, - 0.17419980573340585, - 0.22315456858943353 - ], - "rotation_angle_deg": 1.094373080973492, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.009160822170853011, - 0.035631020705199745, - 0.050925816685260764 - ], - "translation_xyz_cm": [ - 0.9160822170853011, - 3.5631020705199745, - 5.092581668526076 - ], - "translation_norm_m": 0.06282458996604075, - "rotation_rpy_deg_xyz": [ - 1.2256035818958737, - 1.7473335794023404, - 0.16252827758263225 - ], - "rotation_angle_deg": 2.1390418275686742, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.009241948149789625, - 0.005974990400995583, - -0.03870120800208673 - ], - "translation_xyz_cm": [ - -0.9241948149789625, - 0.5974990400995583, - -3.8701208002086727 - ], - "translation_norm_m": 0.04023552679804467, - "rotation_rpy_deg_xyz": [ - -0.21882394740146474, - 2.7657495997671866, - 0.692104867259566 - ], - "rotation_angle_deg": 2.8606767880228787, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.012356414548760797, - 0.005909327159794309, - 0.3914234040867322 - ], - "translation_xyz_cm": [ - 1.2356414548760797, - 0.5909327159794309, - 39.14234040867322 - ], - "translation_norm_m": 0.391662970415672, - "rotation_rpy_deg_xyz": [ - -1.5895613327495874, - 0.7917096078401853, - -0.07471450392114617 - ], - "rotation_angle_deg": 1.7769102049053274, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.012087467857234024, - 0.03642423404658335, - 0.04302373768650984 - ], - "translation_xyz_cm": [ - 1.2087467857234024, - 3.642423404658335, - 4.302373768650984 - ], - "translation_norm_m": 0.05765304596981459, - "rotation_rpy_deg_xyz": [ - 1.4752320083340944, - -0.288066385075703, - 0.06138369095063923 - ], - "rotation_angle_deg": 1.5044966475705575, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0028124570439356233, - 0.017171920464044366, - -0.0060855329481432924 - ], - "translation_xyz_cm": [ - -0.28124570439356233, - 1.7171920464044366, - -0.6085532948143293 - ], - "translation_norm_m": 0.01843416605953159, - "rotation_rpy_deg_xyz": [ - 0.06666652839607351, - 2.3902191860715756, - 0.49137227727804295 - ], - "rotation_angle_deg": 2.4408270388999838, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.034723308148837395, - 0.02579386284078078, - 0.14799510295046941 - ], - "translation_xyz_cm": [ - 3.4723308148837395, - 2.579386284078078, - 14.799510295046941 - ], - "translation_norm_m": 0.15418684115827838, - "rotation_rpy_deg_xyz": [ - -0.22549676160126977, - -0.45660349146265505, - -0.29805804183628326 - ], - "rotation_angle_deg": 0.5905157927181072, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.009768599480856881, - 0.013831920298736922, - 0.3925676510709529 - ], - "translation_xyz_cm": [ - 0.9768599480856881, - 1.3831920298736922, - 39.25676510709529 - ], - "translation_norm_m": 0.39293270189987173, - "rotation_rpy_deg_xyz": [ - -0.8420783474146865, - 0.8041196220812329, - -0.2506805896918132 - ], - "rotation_angle_deg": 1.1897767346278534, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.012873577583242257, - 0.011184392710614277, - 0.0537659214648882 - ], - "translation_xyz_cm": [ - -1.2873577583242257, - 1.1184392710614277, - 5.37659214648882 - ], - "translation_norm_m": 0.05640561985357066, - "rotation_rpy_deg_xyz": [ - 0.914311803299751, - 2.8911533595814927, - 0.6033028113190316 - ], - "rotation_angle_deg": 3.0871688650699287, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03733472595930576, - 0.0041018323591204275, - 0.1863771274968173 - ], - "translation_xyz_cm": [ - 3.733472595930576, - 0.41018323591204275, - 18.637712749681732 - ], - "translation_norm_m": 0.1901240133310984, - "rotation_rpy_deg_xyz": [ - 0.1724099611668595, - 0.10801048841037852, - -0.22142595777305896 - ], - "rotation_angle_deg": 0.30082024849237127, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.04084093867917815, - 0.012273698198451477, - 0.32491122954846857 - ], - "translation_xyz_cm": [ - 4.084093867917815, - 1.2273698198451477, - 32.49112295484686 - ], - "translation_norm_m": 0.32769792954237703, - "rotation_rpy_deg_xyz": [ - -0.09974660217241023, - 0.3614734855715943, - -0.2374587849071741 - ], - "rotation_angle_deg": 0.4436772192283281, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.029155936955684636, - 0.01792559414716033, - 0.06746039629995322 - ], - "translation_xyz_cm": [ - 2.9155936955684636, - 1.7925594147160329, - 6.746039629995322 - ], - "translation_norm_m": 0.07564588987010007, - "rotation_rpy_deg_xyz": [ - 0.9395258367396594, - -2.2317200602672704, - -0.7872831549927726 - ], - "rotation_angle_deg": 2.5404887801395573, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.008747150246597446, - 0.024471120187853135, - 0.20206689819408816 - ], - "translation_xyz_cm": [ - -0.8747150246597446, - 2.4471120187853135, - 20.206689819408815 - ], - "translation_norm_m": 0.20373114564657238, - "rotation_rpy_deg_xyz": [ - 0.7105183450491047, - -0.49341513323104347, - -0.7281562314945353 - ], - "rotation_angle_deg": 1.1287327795625608, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0019238142710493733, - -0.021736356215810826, - 0.16017135543564173 - ], - "translation_xyz_cm": [ - -0.19238142710493733, - -2.1736356215810826, - 16.017135543564173 - ], - "translation_norm_m": 0.16165096147249106, - "rotation_rpy_deg_xyz": [ - -0.9822188470466859, - 0.6077399617285588, - -0.024943407093769944 - ], - "rotation_angle_deg": 1.1551861147970683, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006195543559605332, - -0.008790574477389068, - -0.06572818567635343 - ], - "translation_xyz_cm": [ - 0.6195543559605332, - -0.8790574477389068, - -6.572818567635343 - ], - "translation_norm_m": 0.06660220230552953, - "rotation_rpy_deg_xyz": [ - -0.3657516158987711, - 0.5556943340708838, - 0.09030383031572763 - ], - "rotation_angle_deg": 0.6715984030608765, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0020119721626215004, - 0.027324853801764526, - 0.05588635165229276 - ], - "translation_xyz_cm": [ - 0.20119721626215004, - 2.7324853801764526, - 5.5886351652292765 - ], - "translation_norm_m": 0.06224130435871902, - "rotation_rpy_deg_xyz": [ - -0.7500842503415709, - 0.13739721170970795, - -0.7159356193334792 - ], - "rotation_angle_deg": 1.0453576319486022, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015391867540008874, - -0.04426787878359795, - -0.01257889775156398 - ], - "translation_xyz_cm": [ - 1.5391867540008874, - -4.426787878359795, - -1.257889775156398 - ], - "translation_norm_m": 0.04852610995137362, - "rotation_rpy_deg_xyz": [ - 0.20616013214164947, - 0.42274786560169275, - -0.6238411374677635 - ], - "rotation_angle_deg": 0.7818836753063833, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.017087507778520195, - -0.012143910655748602, - -0.004676112947617883 - ], - "translation_xyz_cm": [ - -1.7087507778520195, - -1.2143910655748602, - -0.4676112947617883 - ], - "translation_norm_m": 0.021478443155747397, - "rotation_rpy_deg_xyz": [ - 0.13518741714234184, - -0.31708003690379677, - -0.7148385236665361 - ], - "rotation_angle_deg": 0.7932673671216353, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012967867542027278, - 0.020876918825978308, - -0.06789086669145025 - ], - "translation_xyz_cm": [ - 1.2967867542027278, - 2.087691882597831, - -6.789086669145025 - ], - "translation_norm_m": 0.07220236220768902, - "rotation_rpy_deg_xyz": [ - 0.546533036681659, - 0.3077707752609976, - 0.14703740182755096 - ], - "rotation_angle_deg": 0.6439010844428541, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.010002899030201517, - 0.007405874355578934, - 0.010801202393750306 - ], - "translation_xyz_cm": [ - 1.0002899030201517, - 0.7405874355578934, - 1.0801202393750307 - ], - "translation_norm_m": 0.016479409489717326, - "rotation_rpy_deg_xyz": [ - 0.8000659261320345, - 0.7502083070271617, - 0.011440669250250453 - ], - "rotation_angle_deg": 1.0967770421942853, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0057849274956982555, - -0.017983977285153552, - -0.014751131428678899 - ], - "translation_xyz_cm": [ - 0.5784927495698255, - -1.7983977285153552, - -1.4751131428678899 - ], - "translation_norm_m": 0.023968410534483987, - "rotation_rpy_deg_xyz": [ - -1.3247175215164335, - -0.9887070900014827, - 0.1495870155867229 - ], - "rotation_angle_deg": 1.6587133268973295, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.014792963497255007, - 0.0011675558864465696, - 0.018750302750541598 - ], - "translation_xyz_cm": [ - 1.4792963497255007, - 0.11675558864465696, - 1.8750302750541596 - ], - "translation_norm_m": 0.02391168770739663, - "rotation_rpy_deg_xyz": [ - -0.3369801569160191, - -0.44131382060417484, - -0.12962818546226149 - ], - "rotation_angle_deg": 0.5704846573401207, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.004523476995069053, - -0.023776281392853982, - 0.02123121034002165 - ], - "translation_xyz_cm": [ - 0.45234769950690534, - -2.377628139285398, - 2.123121034002165 - ], - "translation_norm_m": 0.032195305457462825, - "rotation_rpy_deg_xyz": [ - 0.9863395839523446, - 0.14473673338189408, - -0.19885827835743886 - ], - "rotation_angle_deg": 1.0167856592804465, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.001093972574862545, - 0.020821514700629873, - -0.07685863802874297 - ], - "translation_xyz_cm": [ - -0.1093972574862545, - 2.0821514700629873, - -7.685863802874297 - ], - "translation_norm_m": 0.0796365650317518, - "rotation_rpy_deg_xyz": [ - 0.07839351354656453, - 1.4444892613377576, - 0.0874211670686921 - ], - "rotation_angle_deg": 1.4491941623003552, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00730007263097554, - 0.023632756433413782, - 0.03775545594620744 - ], - "translation_xyz_cm": [ - -0.730007263097554, - 2.363275643341378, - 3.775545594620744 - ], - "translation_norm_m": 0.04513615724410519, - "rotation_rpy_deg_xyz": [ - 0.45965802144635, - 1.0850289311572845, - -0.27377713507938956 - ], - "rotation_angle_deg": 1.210744146287664, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.003055624154584269, - -0.03465194121597037, - -0.0721855466968391 - ], - "translation_xyz_cm": [ - 0.3055624154584269, - -3.465194121597037, - -7.21855466968391 - ], - "translation_norm_m": 0.08013018795017696, - "rotation_rpy_deg_xyz": [ - 0.11303837582162592, - 0.7097073240502726, - -0.09213940327493549 - ], - "rotation_angle_deg": 0.7246244313708499, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0027856268797483708, - 0.03734063036286539, - -0.06491131079846782 - ], - "translation_xyz_cm": [ - 0.2785626879748371, - 3.734063036286539, - -6.491131079846782 - ], - "translation_norm_m": 0.07493704466139965, - "rotation_rpy_deg_xyz": [ - -0.35525507635107045, - 1.395660959680625, - 0.20933845812203183 - ], - "rotation_angle_deg": 1.455919386664132, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.019683204175700464, - 0.014393989359376635, - -0.0818135481089774 - ], - "translation_xyz_cm": [ - -1.9683204175700464, - 1.4393989359376635, - -8.181354810897739 - ], - "translation_norm_m": 0.08537020622254651, - "rotation_rpy_deg_xyz": [ - 0.3766778851966344, - -0.02085119781558297, - 0.3549781833603272 - ], - "rotation_angle_deg": 0.5180528123646785, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.02401503652594328, - 0.015361840958656447, - -0.07568647479031529 - ], - "translation_xyz_cm": [ - -2.401503652594328, - 1.5361840958656447, - -7.568647479031529 - ], - "translation_norm_m": 0.08087738004637933, - "rotation_rpy_deg_xyz": [ - 0.005522607358986495, - 0.618344386566579, - 0.07583938496589472 - ], - "rotation_angle_deg": 0.6229986482255162, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02840093344305472, - 0.0231611045774599, - -0.05294613685657613 - ], - "translation_xyz_cm": [ - -2.840093344305472, - 2.31611045774599, - -5.2946136856576125 - ], - "translation_norm_m": 0.064392105057376, - "rotation_rpy_deg_xyz": [ - 0.3169508560677598, - 0.8404021671832721, - 0.3219519140490075 - ], - "rotation_angle_deg": 0.9533551359049778, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007430498466406199, - -0.007375320165779131, - -0.06490427147402669 - ], - "translation_xyz_cm": [ - -0.7430498466406199, - -0.7375320165779131, - -6.490427147402669 - ], - "translation_norm_m": 0.06574322862912323, - "rotation_rpy_deg_xyz": [ - 0.7315020878250225, - 0.7030821022435286, - 0.48686532359530527 - ], - "rotation_angle_deg": 1.1234208544218196, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.017836379546519954, - -0.015279020470375437, - -0.020221703278414493 - ], - "translation_xyz_cm": [ - 1.7836379546519954, - -1.5279020470375437, - -2.022170327841449 - ], - "translation_norm_m": 0.03099196969122657, - "rotation_rpy_deg_xyz": [ - -0.41972362012907405, - -0.16504820756616775, - -0.24096311642522458 - ], - "rotation_angle_deg": 0.5116277663838326, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007268017590892795, - -0.00041621792080459574, - -0.04480029292641867 - ], - "translation_xyz_cm": [ - -0.7268017590892795, - -0.041621792080459574, - -4.480029292641867 - ], - "translation_norm_m": 0.04538792310022617, - "rotation_rpy_deg_xyz": [ - 0.7705445614767692, - 0.48591493892793053, - 0.269021214931299 - ], - "rotation_angle_deg": 0.9489265343707836, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.003795918508504803, - 0.0023382359452184254, - 0.056835259058409686 - ], - "translation_xyz_cm": [ - 0.3795918508504803, - 0.23382359452184254, - 5.683525905840969 - ], - "translation_norm_m": 0.057009850174292345, - "rotation_rpy_deg_xyz": [ - 1.017807326014229, - -0.0766213174772488, - -0.27710613635684284 - ], - "rotation_angle_deg": 1.0574549794264316, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.009820884373016092, - 0.012375743725220323, - -0.0015315891903759649 - ], - "translation_xyz_cm": [ - -0.9820884373016092, - 1.2375743725220323, - -0.15315891903759649 - ], - "translation_norm_m": 0.015873076830550475, - "rotation_rpy_deg_xyz": [ - 0.9129725268468496, - 0.8586229608111877, - 0.42473803853200953 - ], - "rotation_angle_deg": 1.3211058730643432, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.004164592881661822, - -0.0016251258384434308, - -0.04243447629722068 - ], - "translation_xyz_cm": [ - -0.41645928816618216, - -0.16251258384434308, - -4.243447629722068 - ], - "translation_norm_m": 0.04266930567140914, - "rotation_rpy_deg_xyz": [ - -0.6363288366173377, - 0.8577496367917937, - -0.301672744939005 - ], - "rotation_angle_deg": 1.1084995631908336, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.010361226286380365, - 0.016240693292238984, - 0.14691129439310932 - ], - "translation_xyz_cm": [ - 1.0361226286380365, - 1.6240693292238984, - 14.691129439310933 - ], - "translation_norm_m": 0.14816896958887507, - "rotation_rpy_deg_xyz": [ - 1.628842064863904, - 0.014419510529118263, - -0.4879873339239665 - ], - "rotation_angle_deg": 1.700485230318068, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.00606680495787737, - 0.005982686594818931, - 0.07218548891110065 - ], - "translation_xyz_cm": [ - 0.606680495787737, - 0.5982686594818931, - 7.218548891110064 - ], - "translation_norm_m": 0.07268661135741153, - "rotation_rpy_deg_xyz": [ - 1.0734445867327644, - 0.5419321001404234, - 0.19003238352469107 - ], - "rotation_angle_deg": 1.216612773453556, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011995346942414997, - 0.014353677274124843, - 0.014352532637508422 - ], - "translation_xyz_cm": [ - 1.1995346942414997, - 1.4353677274124843, - 1.4352532637508422 - ], - "translation_norm_m": 0.023577777517598587, - "rotation_rpy_deg_xyz": [ - 0.600916911349819, - 1.27079389638966, - -0.504260779415272 - ], - "rotation_angle_deg": 1.4956571982901619, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008530157902876923, - 0.04282945838975871, - 0.09677134517598567 - ], - "translation_xyz_cm": [ - -0.8530157902876923, - 4.282945838975872, - 9.677134517598567 - ], - "translation_norm_m": 0.10616882474143646, - "rotation_rpy_deg_xyz": [ - -1.2790587683961352, - -0.3774950581840572, - 0.623606153552563 - ], - "rotation_angle_deg": 1.4704080414719172, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.021406984704642085, - 0.027724346006301026, - 0.08179290542272495 - ], - "translation_xyz_cm": [ - 2.1406984704642085, - 2.7724346006301026, - 8.179290542272495 - ], - "translation_norm_m": 0.08897740012560891, - "rotation_rpy_deg_xyz": [ - -0.6525474801936955, - -0.15061563776241266, - 0.5006014364690401 - ], - "rotation_angle_deg": 0.8356095164369179, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006441146407996312, - -0.029776053422077953, - 0.014871384640172902 - ], - "translation_xyz_cm": [ - -0.6441146407996312, - -2.977605342207795, - 1.4871384640172902 - ], - "translation_norm_m": 0.03390073458731616, - "rotation_rpy_deg_xyz": [ - 0.07058201738112876, - -0.6321125293826063, - -0.12469134304681202 - ], - "rotation_angle_deg": 0.6480730635003471, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.024324679836065455, - 0.037292900957834885, - -0.042058734770242745 - ], - "translation_xyz_cm": [ - -2.4324679836065455, - 3.7292900957834885, - -4.205873477024275 - ], - "translation_norm_m": 0.061248572893183376, - "rotation_rpy_deg_xyz": [ - -1.4193217730752687, - -0.5544095720370796, - -0.0672961416555491 - ], - "rotation_angle_deg": 1.5255429468498034, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.009987730151189478, - 0.045768175074627715, - 0.0016304177907325301 - ], - "translation_xyz_cm": [ - 0.9987730151189478, - 4.5768175074627715, - 0.163041779073253 - ], - "translation_norm_m": 0.04687364787817447, - "rotation_rpy_deg_xyz": [ - -0.9462591003561593, - -0.0320128272093377, - -0.08264981688717903 - ], - "rotation_angle_deg": 0.9504239142512766, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0017110732650542637, - -0.0064307487704087785, - 0.03803218718601625 - ], - "translation_xyz_cm": [ - -0.17110732650542637, - -0.6430748770408778, - 3.8032187186016255 - ], - "translation_norm_m": 0.03860996715381504, - "rotation_rpy_deg_xyz": [ - 0.29071620506584944, - -1.1711351895419888, - 0.230890872536377 - ], - "rotation_angle_deg": 1.2291262123611726, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.019568206541706434, - 0.007430112084949536, - 0.04844098442631011 - ], - "translation_xyz_cm": [ - -1.9568206541706434, - 0.7430112084949536, - 4.844098442631011 - ], - "translation_norm_m": 0.05276978534202896, - "rotation_rpy_deg_xyz": [ - -0.8647421894096301, - -1.0761284024191127, - 0.16825462785126682 - ], - "rotation_angle_deg": 1.3897427604875998, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.002335532491152703, - 0.026628740069219337, - -0.036838569949146416 - ], - "translation_xyz_cm": [ - 0.2335532491152703, - 2.6628740069219337, - -3.683856994914642 - ], - "translation_norm_m": 0.04551510458726236, - "rotation_rpy_deg_xyz": [ - -0.21004772032397948, - -0.2381857479272003, - 0.09705544919737065 - ], - "rotation_angle_deg": 0.3319449044423234, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.014591584628913745, - 0.02603676863875437, - -0.08196260963566142 - ], - "translation_xyz_cm": [ - 1.4591584628913745, - 2.603676863875437, - -8.196260963566141 - ], - "translation_norm_m": 0.08722784556217465, - "rotation_rpy_deg_xyz": [ - 0.6149447794511143, - -0.12477360211366718, - 0.09671421259629309 - ], - "rotation_angle_deg": 0.6349869655822359, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.010425522331804604, - 0.003506686399190606, - -0.002630016586996242 - ], - "translation_xyz_cm": [ - -1.0425522331804604, - 0.3506686399190606, - -0.2630016586996242 - ], - "translation_norm_m": 0.011309524863631551, - "rotation_rpy_deg_xyz": [ - 0.09152259365394715, - -0.18115537331124576, - -0.05520965920926705 - ], - "rotation_angle_deg": 0.21029925009144995, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.015913769894105645, - 0.030965829967095404, - -0.055059578507272416 - ], - "translation_xyz_cm": [ - 1.5913769894105645, - 3.0965829967095404, - -5.505957850727242 - ], - "translation_norm_m": 0.06514359433737213, - "rotation_rpy_deg_xyz": [ - 0.4905763640090327, - 0.2754100508757466, - -0.14667929114428876 - ], - "rotation_angle_deg": 0.581700893001357, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022039419583842257, - 0.024753417721427473, - 0.02007412759424619 - ], - "translation_xyz_cm": [ - 2.2039419583842257, - 2.4753417721427473, - 2.007412759424619 - ], - "translation_norm_m": 0.03874839742691568, - "rotation_rpy_deg_xyz": [ - 0.9369056983987799, - 0.292294531847679, - -0.08688584980193773 - ], - "rotation_angle_deg": 0.9854900940619647, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.00170551787494011, - -0.00088688652372515, - 0.011655560694291335 - ], - "translation_xyz_cm": [ - -0.170551787494011, - -0.088688652372515, - 1.1655560694291336 - ], - "translation_norm_m": 0.011813020529314872, - "rotation_rpy_deg_xyz": [ - 0.6243826998929326, - -0.11740240155572751, - 0.0047220900740996465 - ], - "rotation_angle_deg": 0.635346584742639, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.13193704090811176, - "improved_pairs": 30, - "worsened_pairs": 50, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.11498894516263114, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667892170896, - 0.0011901746480735614, - 0.7159624384405358 - ], - "rotation_rpy_deg_xyz": [ - -0.8880870599061297, - 1.4011794298989813, - -0.8376743139361774 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11970563817510238, - "median": 0.06325533412641554, - "p90": 0.19310084706570094, - "p95": 0.23832541866304463, - "max": 0.38846927527625047 - }, - "rotation_deg": { - "rms": 1.2025967761770837, - "median": 0.9422730114817246, - "p90": 1.6905367776655056, - "p95": 2.358465396603872, - "max": 3.021393873617488 - }, - "normalized_pair_score": { - "rms": 3.3936310861155006, - "median": 2.5045673403447166, - "p90": 5.338227884599808, - "p95": 6.124777620601736, - "max": 8.398875362950362 - }, - "normalized_global_rms": 3.3936310861155006 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018308028131136467, - 0.020523534706962887, - 0.08472936472733696 - ], - "translation_xyz_cm": [ - -1.8308028131136467, - 2.0523534706962887, - 8.472936472733696 - ], - "translation_norm_m": 0.08908122483450981, - "rotation_rpy_deg_xyz": [ - 0.4133298132539186, - 0.12669035329399922, - 0.0959088929006429 - ], - "rotation_angle_deg": 0.44272195299870193, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6816953294526065, - "median": 0.7204657180292057, - "p90": 2.2714964920288296, - "p95": 3.825941572676517, - "max": 5.676337113128431 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337455, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018308028131136467, - 0.020523534706962887, - 0.08472936472733696 - ], - "translation_xyz_cm": [ - -1.8308028131136467, - 2.0523534706962887, - 8.472936472733696 - ], - "translation_norm_m": 0.08908122483450981, - "rotation_rpy_deg_xyz": [ - 0.4133298132539186, - 0.12669035329399922, - 0.0959088929006429 - ], - "rotation_angle_deg": 0.44272195299870193, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.019746217900111107, - -0.024250872337705065, - 0.16724475558464919 - ], - "translation_xyz_cm": [ - 1.9746217900111107, - -2.4250872337705065, - 16.724475558464917 - ], - "translation_norm_m": 0.17014354586956093, - "rotation_rpy_deg_xyz": [ - -0.3166393027784575, - -0.26097194946579283, - -0.35373337621089274 - ], - "rotation_angle_deg": 0.5422209572068345, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030643578004140526, - 0.0027130628557821, - 0.14647101453282252 - ], - "translation_xyz_cm": [ - 3.0643578004140526, - 0.27130628557821, - 14.647101453282252 - ], - "translation_norm_m": 0.14966678883850476, - "rotation_rpy_deg_xyz": [ - 0.012401284053658403, - -0.15675144284802262, - -0.38784097350886115 - ], - "rotation_angle_deg": 0.4184879619789227, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0072951330962122765, - -0.0015923192251947604, - 0.09767722857817224 - ], - "translation_xyz_cm": [ - -0.7295133096212276, - -0.15923192251947604, - 9.767722857817224 - ], - "translation_norm_m": 0.09796221429775301, - "rotation_rpy_deg_xyz": [ - 0.6807724150299528, - 0.31326177400749744, - 0.21015021117831667 - ], - "rotation_angle_deg": 0.7777937705957345, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.01678841150250998, - -0.0044051920845928905, - -0.030969335908677002 - ], - "translation_xyz_cm": [ - -1.6788411502509981, - -0.44051920845928905, - -3.0969335908677 - ], - "translation_norm_m": 0.03550149637274801, - "rotation_rpy_deg_xyz": [ - 0.666966358612171, - 0.14835274857297173, - 0.06581121556019229 - ], - "rotation_angle_deg": 0.6863452672238471, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.031105674304975683, - -0.018320390854960622, - 0.07237057458908322 - ], - "translation_xyz_cm": [ - 3.1105674304975683, - -1.8320390854960622, - 7.237057458908322 - ], - "translation_norm_m": 0.0808745928051561, - "rotation_rpy_deg_xyz": [ - 0.4049222257378323, - 0.0903362265771303, - -0.34270162518963887 - ], - "rotation_angle_deg": 0.538317089949407, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04321361413073255, - 0.0057508130022364545, - 0.06216674690072856 - ], - "translation_xyz_cm": [ - 4.321361413073255, - 0.5750813002236455, - 6.216674690072856 - ], - "translation_norm_m": 0.0759288661619926, - "rotation_rpy_deg_xyz": [ - 0.7609771597217877, - 0.4369879302585238, - -0.35711693796066296 - ], - "rotation_angle_deg": 0.9484959462600798, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.002422790428000643, - -0.005651166973108301, - -0.0025240685701327023 - ], - "translation_xyz_cm": [ - 0.2422790428000643, - -0.5651166973108301, - -0.25240685701327026 - ], - "translation_norm_m": 0.006646542241097496, - "rotation_rpy_deg_xyz": [ - 1.057210790206363, - 0.4954937345230715, - 0.031020254183891625 - ], - "rotation_angle_deg": 1.1678528769761969, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005355560449222706, - 0.018953190099781914, - 0.001034254127716271 - ], - "translation_xyz_cm": [ - 0.5355560449222706, - 1.8953190099781914, - 0.1034254127716271 - ], - "translation_norm_m": 0.019722452288811546, - "rotation_rpy_deg_xyz": [ - 0.38575842521579584, - 0.2689016365438749, - -0.02348277658972999 - ], - "rotation_angle_deg": 0.470862327736398, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03770100992436964, - -0.003521129589854788, - -0.036050320974210785 - ], - "translation_xyz_cm": [ - -3.7701009924369635, - -0.3521129589854788, - -3.6050320974210783 - ], - "translation_norm_m": 0.05228183379769297, - "rotation_rpy_deg_xyz": [ - 0.8211246870258724, - 1.01298141493012, - 0.5818673524994079 - ], - "rotation_angle_deg": 1.4249446846361014, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.048480396095955974, - -0.026244675171636533, - -0.045817601351208256 - ], - "translation_xyz_cm": [ - -4.848039609595597, - -2.6244675171636533, - -4.581760135120826 - ], - "translation_norm_m": 0.07168252488622133, - "rotation_rpy_deg_xyz": [ - 0.9143174798321907, - 1.6175728914745098, - 0.501379208245655 - ], - "rotation_angle_deg": 1.9211663050833596, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03246949330763993, - -0.020894924939804493, - -0.043711746760654216 - ], - "translation_xyz_cm": [ - -3.246949330763993, - -2.0894924939804493, - -4.371174676065421 - ], - "translation_norm_m": 0.058323088813629395, - "rotation_rpy_deg_xyz": [ - 0.613867767656471, - 0.5551054566076807, - 0.6018429611292414 - ], - "rotation_angle_deg": 1.0215684034389252, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03916214070591911, - -0.04158777463128871, - -0.053187875122442774 - ], - "translation_xyz_cm": [ - -3.916214070591911, - -4.158777463128871, - -5.318787512244278 - ], - "translation_norm_m": 0.07805233067304035, - "rotation_rpy_deg_xyz": [ - 0.8537800405454072, - 1.123994013439241, - 0.5240450249703229 - ], - "rotation_angle_deg": 1.502701441677025, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012031460642566695, - -0.013723433208756297, - -0.010219439982930172 - ], - "translation_xyz_cm": [ - -1.2031460642566696, - -1.3723433208756297, - -1.0219439982930172 - ], - "translation_norm_m": 0.020917113036782547, - "rotation_rpy_deg_xyz": [ - 0.4451040360188808, - 0.3920215259663075, - -0.08482515530435358 - ], - "rotation_angle_deg": 0.5993757408472615, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.011349712736324957, - -0.013120206811752202, - -0.19126230147191464 - ], - "translation_xyz_cm": [ - 1.1349712736324957, - -1.3120206811752202, - -19.126230147191464 - ], - "translation_norm_m": 0.19204745187144193, - "rotation_rpy_deg_xyz": [ - -0.7561855762732314, - 0.3102395795276442, - 0.3337711633822563 - ], - "rotation_angle_deg": 0.883646851532268, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0018584767081245568, - 0.009447547781280277, - -0.23646401893034735 - ], - "translation_xyz_cm": [ - 0.18584767081245568, - 0.9447547781280277, - -23.646401893034735 - ], - "translation_norm_m": 0.23665997199240493, - "rotation_rpy_deg_xyz": [ - -0.43404382510635076, - -0.0482774920133907, - 0.4354233911964521 - ], - "rotation_angle_deg": 0.6165696337768644, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0027739655447835965, - 0.0005269675343111402, - -0.02382169969889754 - ], - "translation_xyz_cm": [ - -0.27739655447835965, - 0.05269675343111402, - -2.382169969889754 - ], - "translation_norm_m": 0.023988454643230347, - "rotation_rpy_deg_xyz": [ - 0.22521613308362695, - 0.21063914982558243, - -0.09179380842222394 - ], - "rotation_angle_deg": 0.3218589545039531, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.003957689653635479, - 0.027153677352480976, - -0.26857070648997644 - ], - "translation_xyz_cm": [ - 0.39576896536354794, - 2.7153677352480976, - -26.857070648997645 - ], - "translation_norm_m": 0.2699689054052007, - "rotation_rpy_deg_xyz": [ - -0.5936736176164058, - 0.2859224796813103, - 0.07043640674665726 - ], - "rotation_angle_deg": 0.6628493079307487, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0013969138127807312, - 0.014296860255061605, - -0.16765553222955712 - ], - "translation_xyz_cm": [ - -0.13969138127807312, - 1.4296860255061605, - -16.765553222955713 - ], - "translation_norm_m": 0.16826981033010396, - "rotation_rpy_deg_xyz": [ - -0.4572948429465244, - 0.7930492976953605, - 0.2782417816829029 - ], - "rotation_angle_deg": 0.9577162496600404, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00820232354418221, - 0.02560414805079847, - 0.003970968222069174 - ], - "translation_xyz_cm": [ - 0.8202323544182211, - 2.560414805079847, - 0.3970968222069174 - ], - "translation_norm_m": 0.02717754767360985, - "rotation_rpy_deg_xyz": [ - 0.38178306964363307, - -0.6696435101656243, - -0.24563171278079093 - ], - "rotation_angle_deg": 0.8083421817847197, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.013550411155691888, - -0.029362474846422897, - -0.021549511117205197 - ], - "translation_xyz_cm": [ - -1.3550411155691888, - -2.9362474846422897, - -2.1549511117205196 - ], - "translation_norm_m": 0.03886064848900063, - "rotation_rpy_deg_xyz": [ - 0.15057036465776505, - -0.2648836147411245, - -0.47712644962151285 - ], - "rotation_angle_deg": 0.5658195014039604, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.006147769676465464, - 0.006997007757790108, - -0.004740456499939913 - ], - "translation_xyz_cm": [ - 0.6147769676465464, - 0.6997007757790108, - -0.4740456499939913 - ], - "translation_norm_m": 0.010451082115516354, - "rotation_rpy_deg_xyz": [ - 0.5491540044593857, - -0.48139629364696945, - -0.47793644490709286 - ], - "rotation_angle_deg": 0.871507721835889, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.017170245027924413, - 0.010818145906771992, - -0.20854438674507572 - ], - "translation_xyz_cm": [ - -1.7170245027924413, - 1.0818145906771992, - -20.854438674507573 - ], - "translation_norm_m": 0.20952949873003296, - "rotation_rpy_deg_xyz": [ - -0.5693900567142115, - 1.264333653711331, - -0.6379588557878336 - ], - "rotation_angle_deg": 1.5237084376900853, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.02654067404732026, - 0.024674550298363407, - -0.23180169803283907 - ], - "translation_xyz_cm": [ - -2.654067404732026, - 2.4674550298363407, - -23.180169803283906 - ], - "translation_norm_m": 0.23461727988837497, - "rotation_rpy_deg_xyz": [ - -0.12599841179520604, - 1.1909079004848635, - -0.4067089451584119 - ], - "rotation_angle_deg": 1.2643091653489749, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01172904459432944, - 0.029865508286096243, - -0.037866155926814894 - ], - "translation_xyz_cm": [ - 1.172904459432944, - 2.9865508286096243, - -3.7866155926814895 - ], - "translation_norm_m": 0.049632296309525224, - "rotation_rpy_deg_xyz": [ - 0.39289129651074384, - -0.08431089735248867, - -0.010384379216262245 - ], - "rotation_angle_deg": 0.40196231376906344, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013151677616013435, - 0.043680484311303225, - -0.14108408527175736 - ], - "translation_xyz_cm": [ - 1.3151677616013435, - 4.3680484311303225, - -14.108408527175737 - ], - "translation_norm_m": 0.1482756569729302, - "rotation_rpy_deg_xyz": [ - -0.4471323887367807, - -0.20216539939545566, - 0.1651368310129859 - ], - "rotation_angle_deg": 0.5175011948705702, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.0061014274693925175, - 0.017939906562944974, - -0.08992930655763245 - ], - "translation_xyz_cm": [ - 0.6101427469392517, - 1.7939906562944974, - -8.992930655763246 - ], - "translation_norm_m": 0.0919040142898453, - "rotation_rpy_deg_xyz": [ - -0.6992830971495395, - -0.10525656534341715, - 0.16303547565630253 - ], - "rotation_angle_deg": 0.7255662925469465, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.009586776709688882, - -0.0260115770667948, - -0.17401756705698382 - ], - "translation_xyz_cm": [ - -0.9586776709688882, - -2.60115770667948, - -17.401756705698382 - ], - "translation_norm_m": 0.17621186700564492, - "rotation_rpy_deg_xyz": [ - -0.7517400556839972, - 2.3615969394846648, - -0.3709408632062142 - ], - "rotation_angle_deg": 2.5036483964507035, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.00448140837686839, - 0.02011064452047817, - -0.024964547672046943 - ], - "translation_xyz_cm": [ - 0.448140837686839, - 2.011064452047817, - -2.4964547672046944 - ], - "translation_norm_m": 0.03236896174638923, - "rotation_rpy_deg_xyz": [ - 1.0641151375690543, - 0.1397760709936788, - 0.22211591931322267 - ], - "rotation_angle_deg": 1.0957350265151944, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.008385310783696198, - 0.03523455034493139, - 0.05169298231839059 - ], - "translation_xyz_cm": [ - 0.8385310783696198, - 3.5234550344931392, - 5.1692982318390595 - ], - "translation_norm_m": 0.06311855033124666, - "rotation_rpy_deg_xyz": [ - 1.2512030670490764, - 1.681921275671127, - 0.1606690775390495 - ], - "rotation_angle_deg": 2.1009917434223704, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.010283315009607996, - 0.004089496896134914, - -0.03630527965904518 - ], - "translation_xyz_cm": [ - -1.0283315009607996, - 0.40894968961349143, - -3.6305279659045184 - ], - "translation_norm_m": 0.037954497540763285, - "rotation_rpy_deg_xyz": [ - -0.07256669123669232, - 2.678484873230317, - 0.6944737757730357 - ], - "rotation_angle_deg": 2.7684125452335517, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.012344819174259669, - 0.0028148231095586063, - 0.38809659607414093 - ], - "translation_xyz_cm": [ - 1.234481917425967, - 0.2814823109558606, - 38.80965960741409 - ], - "translation_norm_m": 0.38830308481123116, - "rotation_rpy_deg_xyz": [ - -1.389649139598161, - 0.7891247556362943, - -0.06980327432586332 - ], - "rotation_angle_deg": 1.5991711206752781, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.01163152133349521, - 0.03630297318337716, - 0.043486099406410475 - ], - "translation_xyz_cm": [ - 1.163152133349521, - 3.6302973183377163, - 4.3486099406410474 - ], - "translation_norm_m": 0.05782939557066777, - "rotation_rpy_deg_xyz": [ - 1.4823698009239714, - -0.3236952052867369, - 0.06005433749267287 - ], - "rotation_angle_deg": 1.518651447408378, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.004058985285505301, - 0.015698170507638443, - -0.0036012509171343236 - ], - "translation_xyz_cm": [ - -0.4058985285505301, - 1.5698170507638443, - -0.3601250917134324 - ], - "translation_norm_m": 0.016609543250884377, - "rotation_rpy_deg_xyz": [ - 0.17939133580443067, - 2.292463051090093, - 0.49231774726823624 - ], - "rotation_angle_deg": 2.3508241860856183, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03355018858400649, - 0.023448567596873637, - 0.14635122245743354 - ], - "translation_xyz_cm": [ - 3.355018858400649, - 2.3448567596873637, - 14.635122245743354 - ], - "translation_norm_m": 0.15196753202955146, - "rotation_rpy_deg_xyz": [ - -0.05868813509280283, - -0.5295181966438439, - -0.29499193259769874 - ], - "rotation_angle_deg": 0.6091086981010432, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.009126074850025138, - 0.010879512368458855, - 0.3882096454264262 - ], - "translation_xyz_cm": [ - 0.9126074850025139, - 1.0879512368458855, - 38.82096454264262 - ], - "translation_norm_m": 0.38846927527625047, - "rotation_rpy_deg_xyz": [ - -0.6497299330221131, - 0.7672202387200839, - -0.2461030459945505 - ], - "rotation_angle_deg": 1.0340181705456901, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.014094716685800313, - 0.010168504527038158, - 0.05591861572836263 - ], - "translation_xyz_cm": [ - -1.4094716685800313, - 1.0168504527038158, - 5.5918615728362635 - ], - "translation_norm_m": 0.058557246415329826, - "rotation_rpy_deg_xyz": [ - 0.9906402969789201, - 2.7954264576282037, - 0.6020100097999806 - ], - "rotation_angle_deg": 3.021393873617488, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03582684219264498, - 0.002280317339998783, - 0.1845935567059563 - ], - "translation_xyz_cm": [ - 3.582684219264498, - 0.2280317339998783, - 18.45935567059563 - ], - "translation_norm_m": 0.18805197059861642, - "rotation_rpy_deg_xyz": [ - 0.30825825945228247, - 0.016091783321243166, - -0.2199949738044877 - ], - "rotation_angle_deg": 0.37907626812430495, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03967669827270481, - 0.009744054137482028, - 0.3199392389946318 - ], - "translation_xyz_cm": [ - 3.9676698272704813, - 0.9744054137482028, - 31.993923899463176 - ], - "translation_norm_m": 0.32253729028644357, - "rotation_rpy_deg_xyz": [ - 0.07274723735318865, - 0.29404485863227986, - -0.23432982356541152 - ], - "rotation_angle_deg": 0.3830826952762745, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.028243642291319704, - 0.01795799176534829, - 0.06766754640048298 - ], - "translation_xyz_cm": [ - 2.8243642291319704, - 1.7957991765348291, - 6.766754640048298 - ], - "translation_norm_m": 0.07549231506574597, - "rotation_rpy_deg_xyz": [ - 0.9581654180467948, - -2.2883270905657453, - -0.7886946131624508 - ], - "rotation_angle_deg": 2.597337105071797, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.010224055298490686, - 0.024110802595372682, - 0.2008814652045428 - ], - "translation_xyz_cm": [ - -1.0224055298490686, - 2.4110802595372682, - 20.08814652045428 - ], - "translation_norm_m": 0.2025814038140312, - "rotation_rpy_deg_xyz": [ - 0.7619846987721375, - -0.5793917440734514, - -0.7294110231088075 - ], - "rotation_angle_deg": 1.2011320404459533, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0025428559857971766, - -0.02171444324850702, - 0.16069651320703188 - ], - "translation_xyz_cm": [ - -0.25428559857971766, - -2.171444324850702, - 16.069651320703187 - ], - "translation_norm_m": 0.16217691734354464, - "rotation_rpy_deg_xyz": [ - -0.97187684201991, - 0.5648937783916376, - -0.02466150053115295 - ], - "rotation_angle_deg": 1.1242836784787749, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.005311933519814294, - -0.00922872159644017, - -0.06297639603963043 - ], - "translation_xyz_cm": [ - 0.5311933519814294, - -0.922872159644017, - -6.2976396039630425 - ], - "translation_norm_m": 0.06387027789327292, - "rotation_rpy_deg_xyz": [ - -0.3354344324139445, - 0.48541163302250784, - 0.09032434394714607 - ], - "rotation_angle_deg": 0.5971223816377591, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.001317789428953553, - 0.027105802264479673, - 0.0554923969084376 - ], - "translation_xyz_cm": [ - 0.1317789428953553, - 2.7105802264479673, - 5.54923969084376 - ], - "translation_norm_m": 0.0617727059470743, - "rotation_rpy_deg_xyz": [ - -0.7321332182543647, - 0.08167147995274887, - -0.715688364067683 - ], - "rotation_angle_deg": 1.0267156706594092, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014363486438443207, - -0.04484190078305916, - -0.0075989288157305435 - ], - "translation_xyz_cm": [ - 1.4363486438443207, - -4.484190078305916, - -0.7598928815730543 - ], - "translation_norm_m": 0.0476953826659521, - "rotation_rpy_deg_xyz": [ - 0.24418793392591115, - 0.3457060162933294, - -0.6244755669324843 - ], - "rotation_angle_deg": 0.7550021541355014, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.0159006721006274, - -0.013730604030693705, - -0.00013672887163299063 - ], - "translation_xyz_cm": [ - -1.59006721006274, - -1.3730604030693705, - -0.013672887163299063 - ], - "translation_norm_m": 0.021009035082166692, - "rotation_rpy_deg_xyz": [ - 0.25072718354819473, - -0.21691772408353613, - -0.7100352183232977 - ], - "rotation_angle_deg": 0.7831934362945616, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01197247838894544, - 0.02042437386006002, - -0.062423099093715545 - ], - "translation_xyz_cm": [ - 1.197247838894544, - 2.042437386006002, - -6.242309909371555 - ], - "translation_norm_m": 0.06676180484987729, - "rotation_rpy_deg_xyz": [ - 0.575179004530751, - 0.23915360489457557, - 0.14594252503662125 - ], - "rotation_angle_deg": 0.6395103475200503, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.011285477624638496, - 0.006294558717860443, - 0.011000549289057762 - ], - "translation_xyz_cm": [ - 1.1285477624638496, - 0.6294558717860443, - 1.1000549289057762 - ], - "translation_norm_m": 0.016970431913472275, - "rotation_rpy_deg_xyz": [ - 0.888049863257596, - 0.8508269736290145, - 0.016722087943291587 - ], - "rotation_angle_deg": 1.229871417975423, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.004990415930391734, - -0.018142359896662297, - -0.01168007412667868 - ], - "translation_xyz_cm": [ - 0.4990415930391734, - -1.8142359896662297, - -1.1680074126678681 - ], - "translation_norm_m": 0.02214663869265575, - "rotation_rpy_deg_xyz": [ - -1.3088155719149446, - -1.0413902722361166, - 0.15032440922391968 - ], - "rotation_angle_deg": 1.6782325684756834, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.013387977635447967, - 0.0002293141570831464, - 0.02108010876128369 - ], - "translation_xyz_cm": [ - 1.3387977635447967, - 0.02293141570831464, - 2.108010876128369 - ], - "translation_norm_m": 0.024973215963056163, - "rotation_rpy_deg_xyz": [ - -0.26111826251659437, - -0.5369173112666019, - -0.12883961458355384 - ], - "rotation_angle_deg": 0.6110459926587789, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.004170796468343951, - -0.02638573627173535, - 0.023231676303942322 - ], - "translation_xyz_cm": [ - 0.41707964683439513, - -2.638573627173535, - 2.323167630394232 - ], - "translation_norm_m": 0.035402166680488296, - "rotation_rpy_deg_xyz": [ - 1.1835061795895938, - 0.12266214843802319, - -0.19481504495701166 - ], - "rotation_angle_deg": 1.2058928182817992, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.00011901686703952308, - 0.019423171236091274, - -0.07572434645240146 - ], - "translation_xyz_cm": [ - 0.011901686703952308, - 1.9423171236091274, - -7.572434645240146 - ], - "translation_norm_m": 0.07817576601175386, - "rotation_rpy_deg_xyz": [ - 0.18822511258404254, - 1.5454075482443848, - 0.09199270775679586 - ], - "rotation_angle_deg": 1.5593928740933702, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.008243207909465866, - 0.023309778135192527, - 0.0400962293331179 - ], - "translation_xyz_cm": [ - -0.8243207909465866, - 2.3309778135192527, - 4.00962293331179 - ], - "translation_norm_m": 0.04710630361304699, - "rotation_rpy_deg_xyz": [ - 0.48781776403794724, - 1.0168954143654882, - -0.2747674473186411 - ], - "rotation_angle_deg": 1.161856196924386, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0017918541150505618, - -0.036023673983347826, - -0.06646759055798401 - ], - "translation_xyz_cm": [ - 0.17918541150505618, - -3.6023673983347826, - -6.646759055798402 - ], - "translation_norm_m": 0.07562312095524727, - "rotation_rpy_deg_xyz": [ - 0.2152036791775719, - 0.6111661117718465, - -0.09153730903306272 - ], - "rotation_angle_deg": 0.6545420677747905, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.002962074628387823, - 0.03492891228052031, - -0.05808533709171276 - ], - "translation_xyz_cm": [ - 0.2962074628387823, - 3.492891228052031, - -5.808533709171276 - ], - "translation_norm_m": 0.06784326926278186, - "rotation_rpy_deg_xyz": [ - -0.15648409487035153, - 1.4130259010740065, - 0.21440347600220325 - ], - "rotation_angle_deg": 1.4380271717238733, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.01880208119765925, - 0.013687704555194635, - -0.07931723507346516 - ], - "translation_xyz_cm": [ - -1.8802081197659248, - 1.3687704555194635, - -7.931723507346517 - ], - "translation_norm_m": 0.08265648972133405, - "rotation_rpy_deg_xyz": [ - 0.4210490069442282, - 0.06367811338560155, - 0.3580359992133126 - ], - "rotation_angle_deg": 0.5562003178148891, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.025107187676576492, - 0.014520578157459219, - -0.07359808473202388 - ], - "translation_xyz_cm": [ - -2.5107187676576492, - 1.4520578157459219, - -7.359808473202388 - ], - "translation_norm_m": 0.07910686531064091, - "rotation_rpy_deg_xyz": [ - 0.06742655130021073, - 0.5273247002809262, - 0.07580464839684438 - ], - "rotation_angle_deg": 0.5369514960667859, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02951936137211808, - 0.021699840057600173, - -0.05174191310944796 - ], - "translation_xyz_cm": [ - -2.951936137211808, - 2.1699840057600173, - -5.174191310944796 - ], - "translation_norm_m": 0.06339953727409048, - "rotation_rpy_deg_xyz": [ - 0.4321458830053696, - 0.7429945941020288, - 0.3225367221867131 - ], - "rotation_angle_deg": 0.9170653870431814, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0067804054244025025, - -0.009616883331222237, - -0.06389588472480529 - ], - "translation_xyz_cm": [ - -0.6780405424402502, - -0.9616883331222237, - -6.389588472480528 - ], - "translation_norm_m": 0.06497031958895702, - "rotation_rpy_deg_xyz": [ - 0.9150364886219542, - 0.7593731022959056, - 0.4930839501073657 - ], - "rotation_angle_deg": 1.2849397695886449, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.018933231099371062, - -0.01706635836942727, - -0.021439797268817513 - ], - "translation_xyz_cm": [ - 1.8933231099371062, - -1.706635836942727, - -2.1439797268817515 - ], - "translation_norm_m": 0.03330754771495354, - "rotation_rpy_deg_xyz": [ - -0.2739959361410461, - -0.07472731860257172, - -0.2364679843235484 - ], - "rotation_angle_deg": 0.36967476362608587, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.00791509688187525, - -0.0006645515101909583, - -0.04368109149188878 - ], - "translation_xyz_cm": [ - -0.791509688187525, - -0.06645515101909583, - -4.368109149188878 - ], - "translation_norm_m": 0.044397388901622654, - "rotation_rpy_deg_xyz": [ - 0.7856920804565201, - 0.43443582165839323, - 0.2678494433896582 - ], - "rotation_angle_deg": 0.9360500767033693, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0027122133995085562, - 0.0003857782901608431, - 0.05662096923764543 - ], - "translation_xyz_cm": [ - 0.2712213399508556, - 0.03857782901608431, - 5.662096923764543 - ], - "translation_norm_m": 0.056687203880805614, - "rotation_rpy_deg_xyz": [ - 1.171896552829314, - -0.15930961667116292, - -0.2762718049829759 - ], - "rotation_angle_deg": 1.2141430669545952, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.010532730692342618, - 0.00991892874912681, - 0.003458772735744381 - ], - "translation_xyz_cm": [ - -1.0532730692342618, - 0.991892874912681, - 0.3458772735744381 - ], - "translation_norm_m": 0.014875707452259178, - "rotation_rpy_deg_xyz": [ - 1.0964052731064822, - 0.8048813348436072, - 0.42740141570833345 - ], - "rotation_angle_deg": 1.4233759952354188, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.004310796864838373, - -0.004182002767286086, - -0.03772830021220244 - ], - "translation_xyz_cm": [ - -0.4310796864838373, - -0.4182002767286086, - -3.772830021220244 - ], - "translation_norm_m": 0.0382033605021543, - "rotation_rpy_deg_xyz": [ - -0.4365766274362902, - 0.8521345222400444, - -0.296829815653933 - ], - "rotation_angle_deg": 1.0014526712581175, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.009156071769512941, - 0.015144441359405736, - 0.14241025754547937 - ], - "translation_xyz_cm": [ - 0.9156071769512941, - 1.5144441359405736, - 14.241025754547938 - ], - "translation_norm_m": 0.14350564173058394, - "rotation_rpy_deg_xyz": [ - 1.731677787715151, - -0.08408673200827964, - -0.48997544852949654 - ], - "rotation_angle_deg": 1.8012746603738954, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004865762143780206, - 0.004031996980260022, - 0.07644739440636922 - ], - "translation_xyz_cm": [ - 0.48657621437802057, - 0.4031996980260022, - 7.644739440636922 - ], - "translation_norm_m": 0.07670812702974596, - "rotation_rpy_deg_xyz": [ - 1.2163467238214616, - 0.4530234426457634, - 0.19029451214785895 - ], - "rotation_angle_deg": 1.3111453801991766, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011207935810039427, - 0.011896778936440144, - 0.01954380171975209 - ], - "translation_xyz_cm": [ - 1.1207935810039427, - 1.1896778936440144, - 1.9543801719752092 - ], - "translation_norm_m": 0.02547766394011576, - "rotation_rpy_deg_xyz": [ - 0.782650862677196, - 1.2145450826279183, - -0.5014174479076745 - ], - "rotation_angle_deg": 1.53211098991104, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.0077267894240478086, - 0.04273735045120686, - 0.09150707637369258 - ], - "translation_xyz_cm": [ - -0.7726789424047809, - 4.273735045120686, - 9.150707637369258 - ], - "translation_norm_m": 0.10129032246396324, - "rotation_rpy_deg_xyz": [ - -1.2669928698548656, - -0.32838475611462753, - 0.6236140550069756 - ], - "rotation_angle_deg": 1.4482583350275906, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.022931745575129447, - 0.02694243727190626, - 0.07313315127456936 - ], - "translation_xyz_cm": [ - 2.2931745575129447, - 2.694243727190626, - 7.313315127456936 - ], - "translation_norm_m": 0.08124172386540132, - "rotation_rpy_deg_xyz": [ - -0.5813403393406613, - -0.0533875674530456, - 0.5028873736863315 - ], - "rotation_angle_deg": 0.7703427247081398, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0054604092100933865, - -0.030074146710061922, - 0.012165119460757517 - ], - "translation_xyz_cm": [ - -0.5460409210093387, - -3.007414671006192, - 1.2165119460757516 - ], - "translation_norm_m": 0.03289772789379993, - "rotation_rpy_deg_xyz": [ - 0.09860204999404264, - -0.5612134900161805, - -0.12273998617280561 - ], - "rotation_angle_deg": 0.5827772340416, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.023843994828704362, - 0.03485585705986649, - -0.04550668913283122 - ], - "translation_xyz_cm": [ - -2.3843994828704362, - 3.485585705986649, - -4.550668913283122 - ], - "translation_norm_m": 0.06208321525663168, - "rotation_rpy_deg_xyz": [ - -1.2233867084003645, - -0.5250824812941156, - -0.06270086687237508 - ], - "rotation_angle_deg": 1.3330455265639019, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.009869345170068655, - 0.0432911759135276, - -0.0006911479788465069 - ], - "translation_xyz_cm": [ - 0.9869345170068655, - 4.329117591352761, - -0.06911479788465069 - ], - "translation_norm_m": 0.044407291874089934, - "rotation_rpy_deg_xyz": [ - -0.7476401102331566, - -0.0466680591278879, - -0.07781734692923306 - ], - "rotation_angle_deg": 0.7531576543110996, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0007999987008200371, - -0.006616919579693237, - 0.03525995689197188 - ], - "translation_xyz_cm": [ - -0.07999987008200371, - -0.6616919579693237, - 3.525995689197188 - ], - "translation_norm_m": 0.035884372401773404, - "rotation_rpy_deg_xyz": [ - 0.31162258167918894, - -1.1084375697457851, - 0.2327596902837359 - ], - "rotation_angle_deg": 1.1752948223249442, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.018117696831742247, - 0.0062498790715333485, - 0.04386298506735726 - ], - "translation_xyz_cm": [ - -1.8117696831742247, - 0.6249879071533349, - 4.386298506735726 - ], - "translation_norm_m": 0.04786724752808458, - "rotation_rpy_deg_xyz": [ - -0.7686274709824017, - -0.9747426355737412, - 0.170820750693077 - ], - "rotation_angle_deg": 1.2521349920035771, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0033988567742723186, - 0.024781669494690073, - -0.03642730839972336 - ], - "translation_xyz_cm": [ - 0.33988567742723186, - 2.4781669494690073, - -3.6427308399723355 - ], - "translation_norm_m": 0.04418859770986883, - "rotation_rpy_deg_xyz": [ - -0.061629218067020625, - -0.14932558644562688, - 0.10192896992049429 - ], - "rotation_angle_deg": 0.19096969755416157, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.015252662236678649, - 0.023696820561662335, - -0.07933075225995516 - ], - "translation_xyz_cm": [ - 1.525266223667865, - 2.3696820561662335, - -7.933075225995516 - ], - "translation_norm_m": 0.08418759566686893, - "rotation_rpy_deg_xyz": [ - 0.7962174067085034, - -0.0653036453025339, - 0.10285443534716474 - ], - "rotation_angle_deg": 0.805542587356389, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.009411046898971653, - 0.003107271440470516, - -0.00523177106846804 - ], - "translation_xyz_cm": [ - -0.9411046898971653, - 0.3107271440470516, - -0.523177106846804 - ], - "translation_norm_m": 0.011206889312037793, - "rotation_rpy_deg_xyz": [ - 0.12616181360224055, - -0.10401384312915327, - -0.05295281103413361 - ], - "rotation_angle_deg": 0.17183581931680586, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01706925843019791, - 0.029851127106637065, - -0.05325515225488124 - ], - "translation_xyz_cm": [ - 1.706925843019791, - 2.9851127106637065, - -5.325515225488124 - ], - "translation_norm_m": 0.06339211792158443, - "rotation_rpy_deg_xyz": [ - 0.5738725007922081, - 0.37538477872067905, - -0.14207671256597415 - ], - "rotation_angle_deg": 0.7006867619148995, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022652869837350487, - 0.024505315231390323, - 0.020985253163555227 - ], - "translation_xyz_cm": [ - 2.2652869837350487, - 2.4505315231390323, - 2.0985253163555226 - ], - "translation_norm_m": 0.03942136269583103, - "rotation_rpy_deg_xyz": [ - 0.9506024132787494, - 0.3442398290324014, - -0.0848443370866231 - ], - "rotation_angle_deg": 1.014803546829058, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0011438994386434587, - -0.0009696711427749083, - 0.011086512035874404 - ], - "translation_xyz_cm": [ - -0.11438994386434587, - -0.09696711427749083, - 1.1086512035874403 - ], - "translation_norm_m": 0.011187471437838277, - "rotation_rpy_deg_xyz": [ - 0.6334380810079419, - -0.07434429139929981, - 0.006121520030865982 - ], - "rotation_angle_deg": 0.6378191937018343, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.09739546889076545, - "improved_pairs": 33, - "worsened_pairs": 47, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.09243174829989087, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.200_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.2, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3002667883966867, - -0.00132483596826191, - 0.7159622034133878 - ], - "rotation_rpy_deg_xyz": [ - -0.6880496073495588, - 1.404096019030304, - -0.8334758829122912 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11810204126073977, - "median": 0.06044800139365913, - "p90": 0.1940095621381627, - "p95": 0.24164147250683152, - "max": 0.38162743294338947 - }, - "rotation_deg": { - "rms": 1.2102837520093128, - "median": 0.9391857880902855, - "p90": 1.8004766903943166, - "p95": 2.199804102284292, - "max": 2.9009930408954467 - }, - "normalized_pair_score": { - "rms": 3.3820679918494174, - "median": 2.567925960730868, - "p90": 5.261692809346392, - "p95": 5.8892944727391825, - "max": 8.040145815746746 - }, - "normalized_global_rms": 3.3820679918494174 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018973987164132677, - 0.020681058884082226, - 0.0861321537579812 - ], - "translation_xyz_cm": [ - -1.8973987164132677, - 2.0681058884082226, - 8.61321537579812 - ], - "translation_norm_m": 0.09058954849462526, - "rotation_rpy_deg_xyz": [ - 0.4192747598944847, - 0.08111507888294861, - 0.09509638122111481 - ], - "rotation_angle_deg": 0.4374446064319599, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.648644705864238, - "median": 0.7384894986865091, - "p90": 2.2872153823956474, - "p95": 3.7684382589726937, - "max": 5.483696631022495 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.0059241016060887774, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018973987164132677, - 0.020681058884082226, - 0.0861321537579812 - ], - "translation_xyz_cm": [ - -1.8973987164132677, - 2.0681058884082226, - 8.61321537579812 - ], - "translation_norm_m": 0.09058954849462526, - "rotation_rpy_deg_xyz": [ - 0.4192747598944847, - 0.08111507888294861, - 0.09509638122111481 - ], - "rotation_angle_deg": 0.4374446064319599, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.018392462156648026, - -0.024143474164510792, - 0.1689226015440209 - ], - "translation_xyz_cm": [ - 1.8392462156648026, - -2.414347416451079, - 16.892260154402088 - ], - "translation_norm_m": 0.17162760652446382, - "rotation_rpy_deg_xyz": [ - -0.29464217249762054, - -0.3492952410388604, - -0.35393846983410016 - ], - "rotation_angle_deg": 0.5785572072114901, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.028615323883623978, - 0.0023675122260782278, - 0.1486755043517325 - ], - "translation_xyz_cm": [ - 2.8615323883623978, - 0.23675122260782278, - 14.86755043517325 - ], - "translation_norm_m": 0.15142274422736948, - "rotation_rpy_deg_xyz": [ - 0.0650923240292034, - -0.28915471383918456, - -0.3884615306180522 - ], - "rotation_angle_deg": 0.4884893696231875, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.009972394179396757, - -0.0032796640206527172, - 0.099628857912753 - ], - "translation_xyz_cm": [ - -0.9972394179396757, - -0.3279664020652717, - 9.9628857912753 - ], - "translation_norm_m": 0.10018040811833996, - "rotation_rpy_deg_xyz": [ - 0.8181194472839369, - 0.1262004974110094, - 0.20849364777200022 - ], - "rotation_angle_deg": 0.8534277146395284, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.019570704767105984, - -0.006977932279229826, - -0.028890793966739846 - ], - "translation_xyz_cm": [ - -1.9570704767105984, - -0.6977932279229826, - -2.8890793966739845 - ], - "translation_norm_m": 0.03558626139401769, - "rotation_rpy_deg_xyz": [ - 0.8672619521160431, - -0.04878959344336756, - 0.06536501768052598 - ], - "rotation_angle_deg": 0.871116782537574, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03047892684160025, - -0.018247335584083813, - 0.07326288566520843 - ], - "translation_xyz_cm": [ - 3.047892684160025, - -1.8247335584083813, - 7.326288566520843 - ], - "translation_norm_m": 0.0814210086729905, - "rotation_rpy_deg_xyz": [ - 0.41079148185535524, - 0.04506684417959583, - -0.3435028966386386 - ], - "rotation_angle_deg": 0.5374805786383198, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04190447426649746, - 0.0055533493393762345, - 0.06369863736298573 - ], - "translation_xyz_cm": [ - 4.190447426649746, - 0.5553349339376235, - 6.369863736298573 - ], - "translation_norm_m": 0.07644829006810983, - "rotation_rpy_deg_xyz": [ - 0.7866552122475204, - 0.34180771401509846, - -0.35908293872147823 - ], - "rotation_angle_deg": 0.9307418543564996, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -7.503047089962855e-06, - -0.007653746426674601, - -0.0007667790084478834 - ], - "translation_xyz_cm": [ - -0.0007503047089962855, - -0.7653746426674601, - -0.07667790084478834 - ], - "translation_norm_m": 0.007692063488255033, - "rotation_rpy_deg_xyz": [ - 1.2118277938694613, - 0.3035893172631535, - 0.028366794420513326 - ], - "rotation_angle_deg": 1.2495247651816284, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004671442296082028, - 0.01885283326235504, - 0.0017437789301278598 - ], - "translation_xyz_cm": [ - 0.46714422960820284, - 1.885283326235504, - 0.17437789301278597 - ], - "translation_norm_m": 0.019501088690146058, - "rotation_rpy_deg_xyz": [ - 0.3937411018186762, - 0.21579086391681015, - -0.024379131606519704 - ], - "rotation_angle_deg": 0.4496977435560443, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03936274409281117, - -0.004398928452697626, - -0.035219144730973456 - ], - "translation_xyz_cm": [ - -3.9362744092811166, - -0.4398928452697626, - -3.5219144730973455 - ], - "translation_norm_m": 0.05300155044552327, - "rotation_rpy_deg_xyz": [ - 0.8807585778953102, - 0.8733654083396802, - 0.5793338361954974 - ], - "rotation_angle_deg": 1.3661348881774256, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.050523221726368445, - -0.02778120825499608, - -0.04448712036001426 - ], - "translation_xyz_cm": [ - -5.052322172636845, - -2.778120825499608, - -4.448712036001426 - ], - "translation_norm_m": 0.07282510105482619, - "rotation_rpy_deg_xyz": [ - 1.0258958723493214, - 1.4410348549577199, - 0.49869441636986567 - ], - "rotation_angle_deg": 1.8343383866107694, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03362002510835406, - -0.02137338133036501, - -0.04339615941475874 - ], - "translation_xyz_cm": [ - -3.362002510835406, - -2.137338133036501, - -4.3396159414758735 - ], - "translation_norm_m": 0.0589097120153435, - "rotation_rpy_deg_xyz": [ - 0.6406589280541185, - 0.4579648586628709, - 0.600099393182898 - ], - "rotation_angle_deg": 0.9885414113942763, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04085715658343246, - -0.04259957016222049, - -0.05222338101888098 - ], - "translation_xyz_cm": [ - -4.085715658343246, - -4.2599570162220495, - -5.222338101888098 - ], - "translation_norm_m": 0.07881187821091618, - "rotation_rpy_deg_xyz": [ - 0.9208185702814901, - 0.9774428611248394, - 0.521401469179499 - ], - "rotation_angle_deg": 1.437684694959942, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.012817178637925225, - -0.013924411273573745, - -0.009421296553195433 - ], - "translation_xyz_cm": [ - -1.2817178637925224, - -1.3924411273573745, - -0.9421296553195433 - ], - "translation_norm_m": 0.02114072199087265, - "rotation_rpy_deg_xyz": [ - 0.4561732551360771, - 0.329242972905823, - -0.08591136325170003 - ], - "rotation_angle_deg": 0.5692980830809476, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.009720968649376938, - -0.015222776994574846, - -0.19246407036883012 - ], - "translation_xyz_cm": [ - 0.9720968649376938, - -1.5222776994574847, - -19.246407036883014 - ], - "translation_norm_m": 0.19330972182962428, - "rotation_rpy_deg_xyz": [ - -0.6045460427805114, - 0.11907188223440325, - 0.33712451028828877 - ], - "rotation_angle_deg": 0.7026587302005927, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00042921315068678023, - 0.007891697754228336, - -0.238244479858879 - ], - "translation_xyz_cm": [ - 0.04292131506867802, - 0.7891697754228335, - -23.8244479858879 - ], - "translation_norm_m": 0.2383755341904882, - "rotation_rpy_deg_xyz": [ - -0.34102616854102014, - -0.21438643494276255, - 0.43653987654791976 - ], - "rotation_angle_deg": 0.5935229518899147, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.004818247708708978, - -0.0018927316837815122, - -0.021804910559189553 - ], - "translation_xyz_cm": [ - -0.4818247708708978, - -0.18927316837815122, - -2.180491055918955 - ], - "translation_norm_m": 0.02241098098485485, - "rotation_rpy_deg_xyz": [ - 0.41296910824306987, - 0.01387546037043418, - -0.09099841110143247 - ], - "rotation_angle_deg": 0.42311439066973733, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0026019933597565686, - 0.023945556522386724, - -0.27014919704439405 - ], - "translation_xyz_cm": [ - 0.26019933597565686, - 2.3945556522386724, - -27.014919704439404 - ], - "translation_norm_m": 0.27122084859085205, - "rotation_rpy_deg_xyz": [ - -0.3062860013357167, - 0.108946409031264, - 0.07642858977094359 - ], - "rotation_angle_deg": 0.33401531650739374, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0022304088054259097, - 0.013620842664441746, - -0.16674656468759547 - ], - "translation_xyz_cm": [ - -0.22304088054259097, - 1.3620842664441746, - -16.674656468759547 - ], - "translation_norm_m": 0.16731682196791586, - "rotation_rpy_deg_xyz": [ - -0.4384057456863246, - 0.7110607023335067, - 0.2782174579575399 - ], - "rotation_angle_deg": 0.8813181906198819, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00624832110111323, - 0.02436735873579532, - 0.007902847892250833 - ], - "translation_xyz_cm": [ - 0.624832110111323, - 2.436735873579532, - 0.7902847892250833 - ], - "translation_norm_m": 0.026367872366757444, - "rotation_rpy_deg_xyz": [ - 0.4640616350482434, - -0.828437927361824, - -0.24697391319905568 - ], - "rotation_angle_deg": 0.980304242469782, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014931306449701642, - -0.029495355273876908, - -0.01969529865111755 - ], - "translation_xyz_cm": [ - -1.4931306449701642, - -2.949535527387691, - -1.9695298651117548 - ], - "translation_norm_m": 0.03848148495034766, - "rotation_rpy_deg_xyz": [ - 0.17676322966526217, - -0.36095599289152847, - -0.4780811524100847 - ], - "rotation_angle_deg": 0.6241495266963258, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0043875367478831695, - 0.006289086869275262, - -0.002438460113712418 - ], - "translation_xyz_cm": [ - 0.43875367478831695, - 0.6289086869275262, - -0.2438460113712418 - ], - "translation_norm_m": 0.008046687522793595, - "rotation_rpy_deg_xyz": [ - 0.6028489929986481, - -0.6148565870312657, - -0.4797997994431961 - ], - "rotation_angle_deg": 0.9841603383244676, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.018891681297674823, - 0.008146345733542226, - -0.21174739748996188 - ], - "translation_xyz_cm": [ - -1.8891681297674823, - 0.8146345733542226, - -21.17473974899619 - ], - "translation_norm_m": 0.21274449209047747, - "rotation_rpy_deg_xyz": [ - -0.34844330770045223, - 1.0683237331121236, - -0.6336760626924961 - ], - "rotation_angle_deg": 1.2884643233015438, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.027975006249736645, - 0.021500584848571425, - -0.23747793455224725 - ], - "translation_xyz_cm": [ - -2.7975006249736643, - 2.1500584848571425, - -23.747793455224723 - ], - "translation_norm_m": 0.2400846632392516, - "rotation_rpy_deg_xyz": [ - 0.16232596933236504, - 1.0143140156276278, - -0.40213486935758597 - ], - "rotation_angle_deg": 1.1036510686534586, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01117623633153747, - 0.029528775916552452, - -0.03645207789437905 - ], - "translation_xyz_cm": [ - 1.117623633153747, - 2.952877591655245, - -3.645207789437905 - ], - "translation_norm_m": 0.04822458759270238, - "rotation_rpy_deg_xyz": [ - 0.39894841688225, - -0.13032134254642785, - -0.011186991573274872 - ], - "rotation_angle_deg": 0.4198314184624746, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.012070127366619388, - 0.04293767575385199, - -0.138119507825603 - ], - "translation_xyz_cm": [ - 1.2070127366619388, - 4.293767575385199, - -13.8119507825603 - ], - "translation_norm_m": 0.14514244870394102, - "rotation_rpy_deg_xyz": [ - -0.4199100517854488, - -0.3000383607423839, - 0.16519775816782803 - ], - "rotation_angle_deg": 0.5415477115385248, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.00541793481883468, - 0.017633370840178353, - -0.08790300689192557 - ], - "translation_xyz_cm": [ - 0.541793481883468, - 1.7633370840178353, - -8.790300689192557 - ], - "translation_norm_m": 0.08981775106030158, - "rotation_rpy_deg_xyz": [ - -0.6906352800896213, - -0.16059453796596299, - 0.16315730221123403 - ], - "rotation_angle_deg": 0.7273730210004116, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.010693684205269838, - -0.02697399819906421, - -0.17094029692327908 - ], - "translation_xyz_cm": [ - -1.0693684205269838, - -2.697399819906421, - -17.094029692327908 - ], - "translation_norm_m": 0.1733855143111557, - "rotation_rpy_deg_xyz": [ - -0.7098644599804736, - 2.2420553587928995, - -0.37003515487218464 - ], - "rotation_angle_deg": 2.3785044629101413, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.003599254432797905, - 0.019769045917082173, - -0.0223317553222959 - ], - "translation_xyz_cm": [ - 0.3599254432797905, - 1.9769045917082173, - -2.23317553222959 - ], - "translation_norm_m": 0.03004125671004144, - "rotation_rpy_deg_xyz": [ - 1.077417140592766, - 0.07092300845543492, - 0.22020731181732953 - ], - "rotation_angle_deg": 1.1018410778874284, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.00683155025330584, - 0.03444471809894112, - 0.05322450194710519 - ], - "translation_xyz_cm": [ - 0.683155025330584, - 3.444471809894112, - 5.32245019471052 - ], - "translation_norm_m": 0.06376485153512372, - "rotation_rpy_deg_xyz": [ - 1.3024083671352187, - 1.5510868226031156, - 0.15720753267198628 - ], - "rotation_angle_deg": 2.030074644529128, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.012377488149509563, - 0.0003128324039409769, - -0.03153244472572505 - ], - "translation_xyz_cm": [ - -1.2377488149509563, - 0.03128324039409769, - -3.153244472572505 - ], - "translation_norm_m": 0.03387617374180724, - "rotation_rpy_deg_xyz": [ - 0.219918110314789, - 2.50393361529908, - 0.6990103491891652 - ], - "rotation_angle_deg": 2.6076538984750655, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.012322736363741815, - -0.003356863036970248, - 0.3814136589242996 - ], - "translation_xyz_cm": [ - 1.2322736363741815, - -0.3356863036970248, - 38.14136589242996 - ], - "translation_norm_m": 0.38162743294338947, - "rotation_rpy_deg_xyz": [ - -0.9898260594631009, - 0.7839075342729018, - -0.05997895628632437 - ], - "rotation_angle_deg": 1.2637390660739085, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010718716022131591, - 0.03606280886436419, - 0.04441008774758069 - ], - "translation_xyz_cm": [ - 1.0718716022131591, - 3.6062808864364193, - 4.441008774758069 - ], - "translation_norm_m": 0.058203719383717926, - "rotation_rpy_deg_xyz": [ - 1.4966428310331084, - -0.3949598769139032, - 0.057569318810018165 - ], - "rotation_angle_deg": 1.5491391670681876, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.006565155438446046, - 0.012749155072347085, - 0.0013524606209864166 - ], - "translation_xyz_cm": [ - -0.6565155438446046, - 1.2749155072347085, - 0.13524606209864165 - ], - "translation_norm_m": 0.01440386651982828, - "rotation_rpy_deg_xyz": [ - 0.40482300310080055, - 2.096937630069241, - 0.4941515646946025 - ], - "rotation_angle_deg": 2.1903988201460898, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03121095979724342, - 0.018763776351800487, - 0.14303981447225794 - ], - "translation_xyz_cm": [ - 3.121095979724342, - 1.8763776351800487, - 14.303981447225794 - ], - "translation_norm_m": 0.14760281785488888, - "rotation_rpy_deg_xyz": [ - 0.2749117009360588, - -0.6753766053307183, - -0.28910232528837226 - ], - "rotation_angle_deg": 0.7838056568217803, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.007850212023644956, - 0.004995772061092474, - 0.3794654877239586 - ], - "translation_xyz_cm": [ - 0.7850212023644956, - 0.4995772061092474, - 37.94654877239586 - ], - "translation_norm_m": 0.3795795568005268, - "rotation_rpy_deg_xyz": [ - -0.26504843385212423, - 0.6933783731865986, - -0.2371120152723849 - ], - "rotation_angle_deg": 0.778770927159983, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.01654820095885534, - 0.00813958205504961, - 0.06021403456684166 - ], - "translation_xyz_cm": [ - -1.6548200958855341, - 0.813958205504961, - 6.021403456684165 - ], - "translation_norm_m": 0.06297480218168493, - "rotation_rpy_deg_xyz": [ - 1.1432989339853665, - 2.6039625249337144, - 0.5995489063221335 - ], - "rotation_angle_deg": 2.9009930408954467, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.032819974192867196, - -0.0013591514874908839, - 0.1810068078909771 - ], - "translation_xyz_cm": [ - 3.2819974192867196, - -0.1359151487490884, - 18.10068078909771 - ], - "translation_norm_m": 0.18396320964167673, - "rotation_rpy_deg_xyz": [ - 0.5799378859136722, - -0.16776336052831445, - -0.21729560752602692 - ], - "rotation_angle_deg": 0.6413425115229263, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.03736654383954807, - 0.004703740796224931, - 0.3099702236718325 - ], - "translation_xyz_cm": [ - 3.736654383954807, - 0.4703740796224931, - 30.997022367183252 - ], - "translation_norm_m": 0.3122497771643029, - "rotation_rpy_deg_xyz": [ - 0.4177152337796201, - 0.15915681986264738, - -0.2283151629293219 - ], - "rotation_angle_deg": 0.5022044092328275, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.02641852306658854, - 0.018024028992393193, - 0.06807782212424206 - ], - "translation_xyz_cm": [ - 2.641852306658854, - 1.8024028992393193, - 6.807782212424206 - ], - "translation_norm_m": 0.0752156489523187, - "rotation_rpy_deg_xyz": [ - 0.9954325489693011, - -2.4015489546730078, - -0.7912750679280433 - ], - "rotation_angle_deg": 2.7113045438090384, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.013172430853246375, - 0.02338746935026359, - 0.19850153210938523 - ], - "translation_xyz_cm": [ - -1.3172430853246375, - 2.338746935026359, - 19.850153210938522 - ], - "translation_norm_m": 0.20030812491500782, - "rotation_rpy_deg_xyz": [ - 0.8649108842239346, - -0.7513537545530222, - -0.7316985256724738 - ], - "rotation_angle_deg": 1.356340106013626, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.003782147843782502, - -0.021668127711623963, - 0.16174464729300575 - ], - "translation_xyz_cm": [ - -0.3782147843782502, - -2.1668127711623963, - 16.174464729300574 - ], - "translation_norm_m": 0.16323340138825235, - "rotation_rpy_deg_xyz": [ - -0.9511963738833247, - 0.4792018642797731, - -0.023895823355567863 - ], - "rotation_angle_deg": 1.0652626838438728, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.0035343605599285066, - -0.010094914755549134, - -0.05747649418340156 - ], - "translation_xyz_cm": [ - 0.35343605599285066, - -1.0094914755549134, - -5.747649418340156 - ], - "translation_norm_m": 0.05846320545526028, - "rotation_rpy_deg_xyz": [ - -0.27480609300868447, - 0.3448432180840764, - 0.09062398612134058 - ], - "rotation_angle_deg": 0.4503305017017503, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -6.941297240725675e-05, - 0.026666052645710092, - 0.054702269981407994 - ], - "translation_xyz_cm": [ - -0.0069412972407256746, - 2.666605264571009, - 5.4702269981408 - ], - "translation_norm_m": 0.06085574354967139, - "rotation_rpy_deg_xyz": [ - -0.6962379573540999, - -0.02978060835547573, - -0.7149531730567074 - ], - "rotation_angle_deg": 0.9985212240441458, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.012286418662721843, - -0.04597340222358759, - 0.002356240652412785 - ], - "translation_xyz_cm": [ - 1.2286418662721843, - -4.597340222358759, - 0.23562406524127852 - ], - "translation_norm_m": 0.04764516413634788, - "rotation_rpy_deg_xyz": [ - 0.320238695463667, - 0.19161625675391925, - -0.62549171304577 - ], - "rotation_angle_deg": 0.7288195309709571, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.013503150867085534, - -0.016907667213020172, - 0.008926781785890875 - ], - "translation_xyz_cm": [ - -1.3503150867085534, - -1.6907667213020172, - 0.8926781785890875 - ], - "translation_norm_m": 0.023407087110070387, - "rotation_rpy_deg_xyz": [ - 0.48184253706772845, - -0.016609899997639718, - -0.7003383866931551 - ], - "rotation_angle_deg": 0.8501889511876927, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.009961569264336667, - 0.019539845135105427, - -0.051491398774544436 - ], - "translation_xyz_cm": [ - 0.9961569264336667, - 1.9539845135105427, - -5.149139877454443 - ], - "translation_norm_m": 0.05596787076413785, - "rotation_rpy_deg_xyz": [ - 0.6324680034802999, - 0.1019122439723569, - 0.14401115149783847 - ], - "rotation_angle_deg": 0.6564897275663785, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.013851906121959467, - 0.00407244913724103, - 0.011387394955642144 - ], - "translation_xyz_cm": [ - 1.3851906121959467, - 0.407244913724103, - 1.1387394955642143 - ], - "translation_norm_m": 0.01838839060556354, - "rotation_rpy_deg_xyz": [ - 1.064055503098932, - 1.0520577520126284, - 0.02722869228007218 - ], - "rotation_angle_deg": 1.4964014099084317, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0033926666187689136, - -0.018445531903267254, - -0.005540546209690578 - ], - "translation_xyz_cm": [ - 0.33926666187689136, - -1.8445531903267254, - -0.5540546209690578 - ], - "translation_norm_m": 0.01955621349551788, - "rotation_rpy_deg_xyz": [ - -1.2770240095996241, - -1.1467548438631592, - 0.15203240850593552 - ], - "rotation_angle_deg": 1.7219201065116005, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.010566276665619823, - -0.0016440482408790758, - 0.025728860848669308 - ], - "translation_xyz_cm": [ - 1.0566276665619823, - -0.16440482408790758, - 2.572886084866931 - ], - "translation_norm_m": 0.02786258024237791, - "rotation_rpy_deg_xyz": [ - -0.10941048932901865, - -0.7281316445141343, - -0.12713602181800254 - ], - "rotation_angle_deg": 0.7473194122782869, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0034634716431152235, - -0.03161435037486321, - 0.02720593452121836 - ], - "translation_xyz_cm": [ - 0.34634716431152235, - -3.1614350374863207, - 2.720593452121836 - ], - "translation_norm_m": 0.04185242715327389, - "rotation_rpy_deg_xyz": [ - 1.5778317530862305, - 0.07847035500822228, - -0.18682671623830874 - ], - "rotation_angle_deg": 1.590916710995533, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0025510298114899133, - 0.016626182856506855, - -0.07347011996795813 - ], - "translation_xyz_cm": [ - 0.2551029811489913, - 1.6626182856506855, - -7.347011996795813 - ], - "translation_norm_m": 0.07537105702843282, - "rotation_rpy_deg_xyz": [ - 0.4079251099930301, - 1.7472295486682292, - 0.10119681878722177 - ], - "rotation_angle_deg": 1.7967142797035993, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.01013797797020155, - 0.022672791739203557, - 0.044773771742593026 - ], - "translation_xyz_cm": [ - -1.013797797020155, - 2.2672791739203557, - 4.477377174259303 - ], - "translation_norm_m": 0.05120082732370065, - "rotation_rpy_deg_xyz": [ - 0.5441374745819478, - 0.8806217842377861, - -0.2764897168988211 - ], - "rotation_angle_deg": 1.0725350008265442, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00076561840216538, - -0.03876751846638937, - -0.055045112391121837 - ], - "translation_xyz_cm": [ - -0.076561840216538, - -3.8767518466389372, - -5.504511239112183 - ], - "translation_norm_m": 0.06733105567069932, - "rotation_rpy_deg_xyz": [ - 0.419520139483574, - 0.4140722537966934, - -0.09033687706763265 - ], - "rotation_angle_deg": 0.5965624687743472, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0033208507916298036, - 0.030070416003662892, - -0.04445914853296151 - ], - "translation_xyz_cm": [ - 0.33208507916298036, - 3.007041600366289, - -4.445914853296151 - ], - "translation_norm_m": 0.053776145798016685, - "rotation_rpy_deg_xyz": [ - 0.24106663065985232, - 1.447707426740012, - 0.22463832708558612 - ], - "rotation_angle_deg": 1.4842702408164892, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017028913493379427, - 0.012282574373523536, - -0.07432937354062452 - ], - "translation_xyz_cm": [ - -1.7028913493379427, - 1.2282574373523536, - -7.432937354062452 - ], - "translation_norm_m": 0.07723795245180849, - "rotation_rpy_deg_xyz": [ - 0.5098132995631691, - 0.23274049287555254, - 0.3639088931698642 - ], - "rotation_angle_deg": 0.6676469017927036, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.027301615693665626, - 0.012842362235506166, - -0.06942892614596714 - ], - "translation_xyz_cm": [ - -2.7301615693665626, - 1.2842362235506166, - -6.9428926145967145 - ], - "translation_norm_m": 0.07570125674686468, - "rotation_rpy_deg_xyz": [ - 0.19122586419194645, - 0.3452784881582335, - 0.07592122056373715 - ], - "rotation_angle_deg": 0.40182206776112805, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.031762473583748174, - 0.018776589504432173, - -0.04934795159743049 - ], - "translation_xyz_cm": [ - -3.1762473583748174, - 1.8776589504432173, - -4.934795159743048 - ], - "translation_norm_m": 0.06161684322032893, - "rotation_rpy_deg_xyz": [ - 0.6625212882157773, - 0.5481661504006997, - 0.3236371650227935 - ], - "rotation_angle_deg": 0.9176627366914651, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.005476815954407632, - -0.014103887849570063, - -0.06190288941314539 - ], - "translation_xyz_cm": [ - -0.5476815954407632, - -1.4103887849570063, - -6.190288941314539 - ], - "translation_norm_m": 0.06372505694911391, - "rotation_rpy_deg_xyz": [ - 1.2821332099777005, - 0.8719069962359335, - 0.5057811288398129 - ], - "rotation_angle_deg": 1.6278778430519305, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.021121736450374407, - -0.020637841587141548, - -0.023895068275888453 - ], - "translation_xyz_cm": [ - 2.1121736450374407, - -2.0637841587141548, - -2.3895068275888454 - ], - "translation_norm_m": 0.03798713655916164, - "rotation_rpy_deg_xyz": [ - 0.017490457883644672, - 0.10588741294181041, - -0.2272503342425783 - ], - "rotation_angle_deg": 0.2513326583746357, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.009212397670497585, - -0.0011561485230686674, - -0.041444350597687286 - ], - "translation_xyz_cm": [ - -0.9212397670497585, - -0.11561485230686674, - -4.144435059768728 - ], - "translation_norm_m": 0.042471627549586624, - "rotation_rpy_deg_xyz": [ - 0.8159860964657071, - 0.33147097012971344, - 0.2657356748595469 - ], - "rotation_angle_deg": 0.9192736582882443, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0005459267539094093, - -0.003518097548024013, - 0.056172056337877425 - ], - "translation_xyz_cm": [ - 0.054592675390940926, - -0.3518097548024013, - 5.6172056337877425 - ], - "translation_norm_m": 0.05628476667450725, - "rotation_rpy_deg_xyz": [ - 1.4800630316975818, - -0.32470573759214044, - -0.2748262928898388 - ], - "rotation_angle_deg": 1.539231767714016, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.011970614084041653, - 0.004983860003424212, - 0.013414625057635812 - ], - "translation_xyz_cm": [ - -1.1970614084041653, - 0.4983860003424212, - 1.3414625057635812 - ], - "translation_norm_m": 0.018657079822944924, - "rotation_rpy_deg_xyz": [ - 1.463254167994985, - 0.6973660988855817, - 0.4325064697692405 - ], - "rotation_angle_deg": 1.675336485308638, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.00460477665382264, - -0.009320199791573724, - -0.02834253356090269 - ], - "translation_xyz_cm": [ - -0.460477665382264, - -0.9320199791573724, - -2.8342533560902687 - ], - "translation_norm_m": 0.030188893666998402, - "rotation_rpy_deg_xyz": [ - -0.03707483487257376, - 0.8408569621252073, - -0.28715829947856464 - ], - "rotation_angle_deg": 0.8892227576472207, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.006769258671095901, - 0.012952970002234387, - 0.13339513031783 - ], - "translation_xyz_cm": [ - 0.6769258671095901, - 1.2952970002234387, - 13.339513031783001 - ], - "translation_norm_m": 0.1341933794467739, - "rotation_rpy_deg_xyz": [ - 1.937348507196432, - -0.281110556162855, - -0.4939591521133429 - ], - "rotation_angle_deg": 2.0178234732861244, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.0024435052609788066, - 0.00012146433608295482, - 0.0849517722118467 - ], - "translation_xyz_cm": [ - 0.24435052609788066, - 0.012146433608295482, - 8.49517722118467 - ], - "translation_norm_m": 0.08498699355477202, - "rotation_rpy_deg_xyz": [ - 1.502138600313602, - 0.27518957438358843, - 0.19062923236885798 - ], - "rotation_angle_deg": 1.538540657712155, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.009617174116829386, - 0.00696132620388723, - 0.029901544533102814 - ], - "translation_xyz_cm": [ - 0.9617174116829386, - 0.696132620388723, - 2.9901544533102813 - ], - "translation_norm_m": 0.032172231286864, - "rotation_rpy_deg_xyz": [ - 1.1460993199409288, - 1.1020152071618654, - -0.49595854768583897 - ], - "rotation_angle_deg": 1.6687817712737594, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006132904228545399, - 0.04252864900324538, - 0.08097620051626224 - ], - "translation_xyz_cm": [ - -0.6132904228545399, - 4.252864900324537, - 8.097620051626224 - ], - "translation_norm_m": 0.09167029808159054, - "rotation_rpy_deg_xyz": [ - -1.2428546182064482, - -0.23016572168741325, - 0.6234047636101577 - ], - "rotation_angle_deg": 1.4082496327886413, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.025938071397222373, - 0.025365227698297854, - 0.05580251263837309 - ], - "translation_xyz_cm": [ - 2.5938071397222373, - 2.5365227698297854, - 5.580251263837309 - ], - "translation_norm_m": 0.06655898692700851, - "rotation_rpy_deg_xyz": [ - -0.43890402548101426, - 0.14106410887471232, - 0.5073182691111171 - ], - "rotation_angle_deg": 0.685896765498408, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0035087501016763945, - -0.030680524770451967, - 0.0067482409263816545 - ], - "translation_xyz_cm": [ - -0.35087501016763945, - -3.068052477045197, - 0.6748240926381655 - ], - "translation_norm_m": 0.031609249960523, - "rotation_rpy_deg_xyz": [ - 0.154659306750779, - -0.41941145284377374, - -0.11910233077674025 - ], - "rotation_angle_deg": 0.4624670970508773, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.0228867738644023, - 0.029999142326826433, - -0.052428448816658035 - ], - "translation_xyz_cm": [ - -2.28867738644023, - 2.9999142326826433, - -5.242844881665803 - ], - "translation_norm_m": 0.06459485431198378, - "rotation_rpy_deg_xyz": [ - -0.8315080679185178, - -0.46647305410418066, - -0.053347966117142286 - ], - "rotation_angle_deg": 0.9550947850703033, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.009635250536061957, - 0.03834921181877782, - -0.0053602163233892886 - ], - "translation_xyz_cm": [ - 0.9635250536061957, - 3.8349211818777817, - -0.5360216323389289 - ], - "translation_norm_m": 0.039902782096586945, - "rotation_rpy_deg_xyz": [ - -0.3504077545002209, - -0.07602525024264803, - -0.06821304422061156 - ], - "rotation_angle_deg": 0.36503443007510256, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.0010133474903391004, - -0.0070008275396991615, - 0.02971194408133271 - ], - "translation_xyz_cm": [ - 0.10133474903391004, - -0.7000827539699161, - 2.971194408133271 - ], - "translation_norm_m": 0.030542398079866428, - "rotation_rpy_deg_xyz": [ - 0.35345298037323014, - -0.9830372245761048, - 0.23623918745667338 - ], - "rotation_angle_deg": 1.0716940594074802, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.01524035260868839, - 0.0038884645157643005, - 0.03469326164984259 - ], - "translation_xyz_cm": [ - -1.524035260868839, - 0.38884645157643005, - 3.4693261649842593 - ], - "translation_norm_m": 0.03809213708670008, - "rotation_rpy_deg_xyz": [ - -0.5763732633353278, - -0.7719811592017858, - 0.17593968964267515 - ], - "rotation_angle_deg": 0.978643832276281, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.005527915528021232, - 0.02108679956536963, - -0.03562418925964632 - ], - "translation_xyz_cm": [ - 0.5527915528021232, - 2.108679956536963, - -3.5624189259646317 - ], - "translation_norm_m": 0.041764743820621134, - "rotation_rpy_deg_xyz": [ - 0.23523975533165029, - 0.02836574140395858, - 0.11191252615693645 - ], - "rotation_angle_deg": 0.2620185466890971, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.016583632785335034, - 0.019006251764978832, - -0.0740910089242643 - ], - "translation_xyz_cm": [ - 1.6583632785335034, - 1.9006251764978832, - -7.40910089242643 - ], - "translation_norm_m": 0.07826705619817327, - "rotation_rpy_deg_xyz": [ - 1.1587880016999343, - 0.053589502329646314, - 0.11540126870440122 - ], - "rotation_angle_deg": 1.1656986284287496, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.007392358827487788, - 0.002299584639758434, - -0.010440275561473339 - ], - "translation_xyz_cm": [ - -0.7392358827487788, - 0.2299584639758434, - -1.0440275561473338 - ], - "translation_norm_m": 0.012997477153249665, - "rotation_rpy_deg_xyz": [ - 0.19545784094487262, - 0.05027283877818703, - -0.04870039537702608 - ], - "rotation_angle_deg": 0.20763237133273368, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01938979041659894, - 0.027623562829441006, - -0.04965689814650259 - ], - "translation_xyz_cm": [ - 1.938979041659894, - 2.7623562829441006, - -4.9656898146502595 - ], - "translation_norm_m": 0.060040259237646866, - "rotation_rpy_deg_xyz": [ - 0.7404990012722054, - 0.5753289283051378, - -0.1329524689930178 - ], - "rotation_angle_deg": 0.9476297218240715, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.023882212921079393, - 0.024013262194517937, - 0.022806038590571127 - ], - "translation_xyz_cm": [ - 2.3882212921079393, - 2.4013262194517937, - 2.2806038590571127 - ], - "translation_norm_m": 0.04083028595815924, - "rotation_rpy_deg_xyz": [ - 0.9780054268978662, - 0.44813781653124385, - -0.08099492882049739 - ], - "rotation_angle_deg": 1.0791185263419745, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -2.188880732822973e-05, - -0.0011379611737887263, - 0.00994695099756447 - ], - "translation_xyz_cm": [ - -0.002188880732822973, - -0.11379611737887263, - 0.994695099756447 - ], - "translation_norm_m": 0.010011856416313893, - "rotation_rpy_deg_xyz": [ - 0.6515567972657927, - 0.011777307786223391, - 0.008716078568098931 - ], - "rotation_angle_deg": 0.6517206191423869, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.0858323746246823, - "improved_pairs": 32, - "worsened_pairs": 48, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.07205204282391175, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.200", - "body_left_rpy_correction_deg_xyz": [ - -0.2, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.301514381728528, - 0.0024476764333135038, - 0.7136887808759609 - ], - "rotation_rpy_deg_xyz": [ - -0.98957173596909, - 1.4997049033829544, - -0.8398067936647792 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.1208887180452031, - "median": 0.06230452978178093, - "p90": 0.1923035837156721, - "p95": 0.23889158948071956, - "max": 0.3912445921911723 - }, - "rotation_deg": { - "rms": 1.263543756747655, - "median": 0.9926334845736982, - "p90": 1.8047444681595712, - "p95": 2.545451576038396, - "max": 3.1881432057003205 - }, - "normalized_pair_score": { - "rms": 3.4973996284538247, - "median": 2.6130870995728896, - "p90": 5.458045802774578, - "p95": 6.305428683150946, - "max": 8.661785937148464 - }, - "normalized_global_rms": 3.4973996284538247 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018051015766721135, - 0.020151337701768135, - 0.0831010620283244 - ], - "translation_xyz_cm": [ - -1.8051015766721135, - 2.0151337701768135, - 8.31010620283244 - ], - "translation_norm_m": 0.08739394768298625, - "rotation_rpy_deg_xyz": [ - 0.4331419512482041, - 0.15243743025603146, - 0.09702280854064964 - ], - "rotation_angle_deg": 0.469202063453847, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.7135991876939975, - "median": 0.7501993496833461, - "p90": 2.4068068761684835, - "p95": 3.7744794821981595, - "max": 5.799621427831512 - }, - "height_residual_m": { - "rms": 0.03471396517121731, - "median": -0.0059241016060887774, - "p90": 0.0534092673419908, - "p95": 0.08720196104337465, - "max": 0.12336745254185413 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018051015766721135, - 0.020151337701768135, - 0.0831010620283244 - ], - "translation_xyz_cm": [ - -1.8051015766721135, - 2.0151337701768135, - 8.31010620283244 - ], - "translation_norm_m": 0.08739394768298625, - "rotation_rpy_deg_xyz": [ - 0.4331419512482041, - 0.15243743025603146, - 0.09702280854064964 - ], - "rotation_angle_deg": 0.469202063453847, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.020420318308966845, - -0.024929435096151975, - 0.16414341760769002 - ], - "translation_xyz_cm": [ - 2.0420318308966845, - -2.4929435096151975, - 16.414341760769002 - ], - "translation_norm_m": 0.16727679958077063, - "rotation_rpy_deg_xyz": [ - -0.28349894948789645, - -0.20582072153892836, - -0.3522791585658297 - ], - "rotation_angle_deg": 0.4971847915696293, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.031873736947572895, - 0.0019473803789511468, - 0.14284042028328708 - ], - "translation_xyz_cm": [ - 3.1873736947572895, - 0.19473803789511468, - 14.284042028328708 - ], - "translation_norm_m": 0.14636636589069735, - "rotation_rpy_deg_xyz": [ - 0.052225965451009757, - -0.06422826164103784, - -0.38526393791675834 - ], - "rotation_angle_deg": 0.39402860495941056, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.005097874477914842, - -0.001983514472637893, - 0.09378121009515547 - ], - "translation_xyz_cm": [ - -0.5097874477914842, - -0.19835144726378928, - 9.378121009515548 - ], - "translation_norm_m": 0.09394060900785894, - "rotation_rpy_deg_xyz": [ - 0.7056144160114264, - 0.475395998003639, - 0.21539818864608387 - ], - "rotation_angle_deg": 0.8769405056462304, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.014082389818032115, - -0.004393628685045892, - -0.03532397202429931 - ], - "translation_xyz_cm": [ - -1.4082389818032115, - -0.43936286850458917, - -3.5323972024299306 - ], - "translation_norm_m": 0.03828055218492221, - "rotation_rpy_deg_xyz": [ - 0.665343754276177, - 0.3469950261785394, - 0.07133543025592341 - ], - "rotation_angle_deg": 0.7535832629547333, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.031398520152168596, - -0.01862805064169487, - 0.07065047206662463 - ], - "translation_xyz_cm": [ - 3.1398520152168596, - -1.862805064169487, - 7.065047206662463 - ], - "translation_norm_m": 0.0795258482613835, - "rotation_rpy_deg_xyz": [ - 0.42461878167074496, - 0.11589244428606872, - -0.3415989378450803 - ], - "rotation_angle_deg": 0.5574179395629395, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.043965429507528575, - 0.005255360714502388, - 0.05992479139987991 - ], - "translation_xyz_cm": [ - 4.396542950752858, - 0.5255360714502388, - 5.992479139987991 - ], - "translation_norm_m": 0.0745087809076227, - "rotation_rpy_deg_xyz": [ - 0.7957346372933841, - 0.4973850449717815, - -0.3544262605151436 - ], - "rotation_angle_deg": 1.0043131899385098, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.004632353281443985, - -0.005768429801324748, - -0.005659590071692734 - ], - "translation_xyz_cm": [ - 0.4632353281443985, - -0.5768429801324748, - -0.5659590071692734 - ], - "translation_norm_m": 0.009314743103087669, - "rotation_rpy_deg_xyz": [ - 1.075864358253325, - 0.6686559146756033, - 0.03755470549416832 - ], - "rotation_angle_deg": 1.2670874038659605, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005742089256763339, - 0.018673595056920705, - 0.0005597402103323635 - ], - "translation_xyz_cm": [ - 0.5742089256763339, - 1.8673595056920704, - 0.05597402103323635 - ], - "translation_norm_m": 0.01954451458812813, - "rotation_rpy_deg_xyz": [ - 0.4083206136191783, - 0.2994346188786608, - -0.022199468447199017 - ], - "rotation_angle_deg": 0.5068792956672864, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03644438630867561, - -0.003888195467354638, - -0.03698975655455679 - ], - "translation_xyz_cm": [ - -3.644438630867561, - -0.3888195467354638, - -3.698975655455679 - ], - "translation_norm_m": 0.05207257865108771, - "rotation_rpy_deg_xyz": [ - 0.8611520475748974, - 1.1125664691123769, - 0.5859748595076418 - ], - "rotation_angle_deg": 1.5208268873775865, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.046722138313324196, - -0.0264657551300993, - -0.047347653442448095 - ], - "translation_xyz_cm": [ - -4.67221383133242, - -2.64657551300993, - -4.73476534424481 - ], - "translation_norm_m": 0.0715904650751896, - "rotation_rpy_deg_xyz": [ - 0.94688966691107, - 1.7615816275220235, - 0.5069030100143088 - ], - "rotation_angle_deg": 2.0595792292482162, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03165628809560356, - -0.02121419904026775, - -0.0442356755648179 - ], - "translation_xyz_cm": [ - -3.1656288095603555, - -2.121419904026775, - -4.423567556481791 - ], - "translation_norm_m": 0.05838628100493965, - "rotation_rpy_deg_xyz": [ - 0.6490496184360491, - 0.6170439672038027, - 0.6044315331753985 - ], - "rotation_angle_deg": 1.0784756435036624, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03782520867541758, - -0.04190133752583347, - -0.054296499132285736 - ], - "translation_xyz_cm": [ - -3.7825208675417583, - -4.190133752583347, - -5.429649913228573 - ], - "translation_norm_m": 0.07832354892249847, - "rotation_rpy_deg_xyz": [ - 0.8935814411301355, - 1.230747354194319, - 0.5284301483552231 - ], - "rotation_angle_deg": 1.6069459004138438, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.011546380918701936, - -0.014004267806995957, - -0.010680986964364866 - ], - "translation_xyz_cm": [ - -1.1546380918701935, - -1.4004267806995956, - -1.0680986964364865 - ], - "translation_norm_m": 0.02105995991598179, - "rotation_rpy_deg_xyz": [ - 0.47095906320516806, - 0.42892932544534745, - -0.0832705598306114 - ], - "rotation_angle_deg": 0.6426579742708466, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.013213272192402314, - -0.012885959102921243, - -0.19093882818808125 - ], - "translation_xyz_cm": [ - 1.3213272192402314, - -1.2885959102921243, - -19.093882818808126 - ], - "translation_norm_m": 0.1918287637813221, - "rotation_rpy_deg_xyz": [ - -0.7364486876580132, - 0.4816548712445948, - 0.3348466986290199 - ], - "rotation_angle_deg": 0.9426229417607185, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.003363893798918771, - 0.009499573863055588, - -0.23609706526952753 - ], - "translation_xyz_cm": [ - 0.3363893798918771, - 0.9499573863055588, - -23.609706526952753 - ], - "translation_norm_m": 0.23631204352286744, - "rotation_rpy_deg_xyz": [ - -0.3975368722016733, - 0.08128327083932424, - 0.437530543232579 - ], - "rotation_angle_deg": 0.5969266610138643, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0005623136262358219, - 0.0007546865844533235, - -0.025244767741295124 - ], - "translation_xyz_cm": [ - -0.05623136262358219, - 0.07546865844533235, - -2.5244767741295124 - ], - "translation_norm_m": 0.025262304858562276, - "rotation_rpy_deg_xyz": [ - 0.2296786177016426, - 0.40285711750675024, - -0.08776807863855862 - ], - "rotation_angle_deg": 0.47211316287881644, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.006268420560433793, - 0.028076134671654707, - -0.26981909010394645 - ], - "translation_xyz_cm": [ - 0.6268420560433794, - 2.8076134671654707, - -26.981909010394645 - ], - "translation_norm_m": 0.2713483071974928, - "rotation_rpy_deg_xyz": [ - -0.6489261264282472, - 0.5181195161619379, - 0.07032421802129633 - ], - "rotation_angle_deg": 0.8336115188746338, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0006240570466555795, - 0.0142502364891679, - -0.17100714341319317 - ], - "translation_xyz_cm": [ - -0.06240570466555795, - 1.42502364891679, - -17.100714341319318 - ], - "translation_norm_m": 0.17160099587570904, - "rotation_rpy_deg_xyz": [ - -0.4257436776127224, - 0.8434833188121017, - 0.2794781412872418 - ], - "rotation_angle_deg": 0.9861929001986818, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.009812086324250624, - 0.025364218314138487, - 0.00024259780231962458 - ], - "translation_xyz_cm": [ - 0.9812086324250624, - 2.5364218314138487, - 0.024259780231962458 - ], - "translation_norm_m": 0.027197048781357043, - "rotation_rpy_deg_xyz": [ - 0.41997537231708715, - -0.5491605085901998, - -0.24184548649952564 - ], - "rotation_angle_deg": 0.7317583285030299, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.01285319674429064, - -0.02998446670986658, - -0.02081493353164575 - ], - "translation_xyz_cm": [ - -1.285319674429064, - -2.998446670986658, - -2.081493353164575 - ], - "translation_norm_m": 0.03869798920292076, - "rotation_rpy_deg_xyz": [ - 0.18548743995146122, - -0.20377501273598764, - -0.475061277637893 - ], - "rotation_angle_deg": 0.5489072755711314, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0073340229931010414, - 0.006501801322340461, - -0.005280991311036171 - ], - "translation_xyz_cm": [ - 0.7334022993101041, - 0.6501801322340461, - -0.5280991311036172 - ], - "translation_norm_m": 0.011133291648284548, - "rotation_rpy_deg_xyz": [ - 0.5889970319929645, - -0.38787308272256366, - -0.4744645856168187 - ], - "rotation_angle_deg": 0.8488719986241952, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01497255514653395, - 0.011308383279616141, - -0.21130273290327048 - ], - "translation_xyz_cm": [ - -1.497255514653395, - 1.130838327961614, - -21.130273290327047 - ], - "translation_norm_m": 0.21213416007895938, - "rotation_rpy_deg_xyz": [ - -0.5818442992007573, - 1.472785006468197, - -0.6369530914674234 - ], - "rotation_angle_deg": 1.7040471798217154, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.024194663579997992, - 0.025593828800067442, - -0.2345538563205356 - ], - "translation_xyz_cm": [ - -2.419466357999799, - 2.559382880006744, - -23.45538563205356 - ], - "translation_norm_m": 0.23718334117983686, - "rotation_rpy_deg_xyz": [ - -0.18185720258582413, - 1.42332033621492, - -0.40493996628078727 - ], - "rotation_angle_deg": 1.4903186097098393, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.012177461625344221, - 0.02979676572443879, - -0.03937929597398699 - ], - "translation_xyz_cm": [ - 1.2177461625344221, - 2.979676572443879, - -3.937929597398699 - ], - "translation_norm_m": 0.05086125018794455, - "rotation_rpy_deg_xyz": [ - 0.41286211393560673, - -0.058291512719505244, - -0.009269123506073437 - ], - "rotation_angle_deg": 0.4170551927153903, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014101811190542546, - 0.04357321985924045, - -0.14449695749386784 - ], - "translation_xyz_cm": [ - 1.4101811190542546, - 4.357321985924045, - -14.449695749386784 - ], - "translation_norm_m": 0.15158119043186086, - "rotation_rpy_deg_xyz": [ - -0.4118311517782897, - -0.139623208452716, - 0.16658682450863044 - ], - "rotation_angle_deg": 0.4654925421801478, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006615935003051854, - 0.017784509792113212, - -0.09186060009006444 - ], - "translation_xyz_cm": [ - 0.6615935003051854, - 1.7784509792113212, - -9.186060009006445 - ], - "translation_norm_m": 0.09379994260881573, - "rotation_rpy_deg_xyz": [ - -0.6759497856775561, - -0.07326404264921663, - 0.16376659133726065 - ], - "rotation_angle_deg": 0.6992519594373157, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.008642153145500098, - -0.026093028204591917, - -0.17994184404007801 - ], - "translation_xyz_cm": [ - -0.8642153145500098, - -2.6093028204591917, - -17.9941844040078 - ], - "translation_norm_m": 0.1820291190123703, - "rotation_rpy_deg_xyz": [ - -0.7128586334199032, - 2.4422911341041456, - -0.369665723972703 - ], - "rotation_angle_deg": 2.5687105672658888, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.005070904260630782, - 0.019911186946612203, - -0.027396761566674692 - ], - "translation_xyz_cm": [ - 0.5070904260630782, - 1.9911186946612203, - -2.739676156667469 - ], - "translation_norm_m": 0.03424546656105954, - "rotation_rpy_deg_xyz": [ - 1.0918948410427214, - 0.18082144620075774, - 0.22426501469070864 - ], - "rotation_angle_deg": 1.1289154876040923, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.009494748159367461, - 0.035003683689017295, - 0.046895916516284206 - ], - "translation_xyz_cm": [ - 0.9494748159367461, - 3.5003683689017295, - 4.689591651628421 - ], - "translation_norm_m": 0.05928435797335487, - "rotation_rpy_deg_xyz": [ - 1.291100007834987, - 1.772913079305066, - 0.1651900619635742 - ], - "rotation_angle_deg": 2.197888070489705, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0075202263191553875, - 0.004949460182837484, - -0.044180088787570536 - ], - "translation_xyz_cm": [ - -0.7520226319155388, - 0.4949460182837484, - -4.418008878757053 - ], - "translation_norm_m": 0.045088038383482895, - "rotation_rpy_deg_xyz": [ - -0.13141796299195327, - 2.9118944077373956, - 0.6963927080460064 - ], - "rotation_angle_deg": 2.997649975418199, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.01541512525021449, - 0.005837338313652962, - 0.3901795324109684 - ], - "translation_xyz_cm": [ - 1.541512525021449, - 0.5837338313652962, - 39.01795324109684 - ], - "translation_norm_m": 0.3905275510351476, - "rotation_rpy_deg_xyz": [ - -1.5869653851852432, - 0.9916047848594443, - -0.07673961632406161 - ], - "rotation_angle_deg": 1.8722865949140228, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.012267441765530629, - 0.036106877073371346, - 0.04010258898977165 - ], - "translation_xyz_cm": [ - 1.226744176553063, - 3.6106877073371346, - 4.010258898977165 - ], - "translation_norm_m": 0.05533908513107882, - "rotation_rpy_deg_xyz": [ - 1.510867856392408, - -0.2809786044157495, - 0.0625937777625319 - ], - "rotation_angle_deg": 1.5381962172873593, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0014503730930339742, - 0.01595304605296488, - -0.00981584807186745 - ], - "translation_xyz_cm": [ - -0.14503730930339742, - 1.595304605296488, - -0.981584807186745 - ], - "translation_norm_m": 0.018787073583903358, - "rotation_rpy_deg_xyz": [ - 0.16455411609086243, - 2.502872906147794, - 0.4960210644920037 - ], - "rotation_angle_deg": 2.5561452617233495, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03718844418292466, - 0.02460973110280884, - 0.14456771629786297 - ], - "translation_xyz_cm": [ - 3.7188444182924663, - 2.460973110280884, - 14.456771629786298 - ], - "translation_norm_m": 0.1512892720627555, - "rotation_rpy_deg_xyz": [ - -0.15268476934163852, - -0.2897582796962913, - -0.2938853749834466 - ], - "rotation_angle_deg": 0.4403041625771233, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.012733146028711805, - 0.013135002213390923, - 0.39081667009980836 - ], - "translation_xyz_cm": [ - 1.2733146028711804, - 1.3135002213390923, - 39.08166700998083 - ], - "translation_norm_m": 0.3912445921911723, - "rotation_rpy_deg_xyz": [ - -0.8051862529275607, - 0.9964610796505318, - -0.24919274640429967 - ], - "rotation_angle_deg": 1.3037822407371935, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.011929458372255342, - 0.00991724796848309, - 0.05369555411995503 - ], - "translation_xyz_cm": [ - -1.1929458372255342, - 0.9917247968483089, - 5.369555411995504 - ], - "translation_norm_m": 0.055891648003729276, - "rotation_rpy_deg_xyz": [ - 1.0102547173921472, - 2.967444274766301, - 0.6083313462743337 - ], - "rotation_angle_deg": 3.1881432057003205, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.039202922000712626, - 0.002582505053778217, - 0.18511280833682395 - ], - "translation_xyz_cm": [ - 3.9202922000712626, - 0.2582505053778217, - 18.511280833682395 - ], - "translation_norm_m": 0.18923607012430918, - "rotation_rpy_deg_xyz": [ - 0.264264411472533, - 0.24382119350282697, - -0.21623936009353245 - ], - "rotation_angle_deg": 0.4198652551005484, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.04343417100805391, - 0.011019869338201982, - 0.3242699297367874 - ], - "translation_xyz_cm": [ - 4.343417100805391, - 1.1019869338201982, - 32.42699297367874 - ], - "translation_norm_m": 0.32735141982720795, - "rotation_rpy_deg_xyz": [ - -0.032366500572003604, - 0.533953410464245, - -0.23297595617737363 - ], - "rotation_angle_deg": 0.5834046249013255, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.029365850596501986, - 0.017160726632123202, - 0.06338031439706832 - ], - "translation_xyz_cm": [ - 2.9365850596501986, - 1.7160726632123202, - 6.338031439706832 - ], - "translation_norm_m": 0.07192988233599276, - "rotation_rpy_deg_xyz": [ - 0.9960502916886979, - -2.213189172352863, - -0.7852151667990662 - ], - "rotation_angle_deg": 2.54488875047603, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.00813659963515212, - 0.023154395690902607, - 0.1950388990379711 - ], - "translation_xyz_cm": [ - -0.813659963515212, - 2.3154395690902607, - 19.50388990379711 - ], - "translation_norm_m": 0.19657696312482173, - "rotation_rpy_deg_xyz": [ - 0.7964364405417946, - -0.4420331854604296, - -0.7244169831801925 - ], - "rotation_angle_deg": 1.1619031628765932, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0019087174620349145, - -0.022348716345503616, - 0.1569602442190412 - ], - "translation_xyz_cm": [ - -0.19087174620349145, - -2.2348716345503616, - 15.69602442190412 - ], - "translation_norm_m": 0.15855480626566548, - "rotation_rpy_deg_xyz": [ - -0.9393744771492628, - 0.6180824986251228, - -0.02385428866221854 - ], - "rotation_angle_deg": 1.1246195381529136, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.006662189576916999, - -0.00959464687114897, - -0.06983481891776873 - ], - "translation_xyz_cm": [ - 0.6662189576916999, - -0.9594646871148971, - -6.983481891776873 - ], - "translation_norm_m": 0.07080497123661854, - "rotation_rpy_deg_xyz": [ - -0.2954742630811605, - 0.5859994486979809, - 0.09243023600363653 - ], - "rotation_angle_deg": 0.6629647140877852, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.002353136500063968, - 0.026643500399378572, - 0.049694683540802045 - ], - "translation_xyz_cm": [ - 0.2353136500063968, - 2.6643500399378572, - 4.969468354080204 - ], - "translation_norm_m": 0.0564355821901403, - "rotation_rpy_deg_xyz": [ - -0.6943737133033362, - 0.1553475237138117, - -0.7144422675151366 - ], - "rotation_angle_deg": 1.0076524915060436, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.015864541141074273, - -0.04522281644810078, - -0.011889074679914912 - ], - "translation_xyz_cm": [ - 1.5864541141074273, - -4.522281644810078, - -1.1889074679914913 - ], - "translation_norm_m": 0.04937749375839205, - "rotation_rpy_deg_xyz": [ - 0.2831954284829599, - 0.46074216746342206, - -0.6210734610399845 - ], - "rotation_angle_deg": 0.8243945162420219, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.015492320992356756, - -0.0107431327302141, - -0.008669058937056995 - ], - "translation_xyz_cm": [ - -1.5492320992356756, - -1.07431327302141, - -0.8669058937056995 - ], - "translation_norm_m": 0.020750409476523183, - "rotation_rpy_deg_xyz": [ - 0.03498075073667812, - -0.2014573359833879, - -0.7152075795733939 - ], - "rotation_angle_deg": 0.7438024478943476, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.013255546541666607, - 0.01993572806738797, - -0.06604187760069928 - ], - "translation_xyz_cm": [ - 1.3255546541666607, - 1.993572806738797, - -6.604187760069928 - ], - "translation_norm_m": 0.07024722318156694, - "rotation_rpy_deg_xyz": [ - 0.615147457787683, - 0.33637366349083136, - 0.1495580048982771 - ], - "rotation_angle_deg": 0.7165052335273462, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.011149829273089884, - 0.008838813696251169, - 0.006149318580873905 - ], - "translation_xyz_cm": [ - 1.1149829273089884, - 0.8838813696251169, - 0.6149318580873906 - ], - "translation_norm_m": 0.01550023997830906, - "rotation_rpy_deg_xyz": [ - 0.6993633309474104, - 0.8381801933531612, - 0.01156111546120214 - ], - "rotation_angle_deg": 1.0916326104012055, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.005715235315443046, - -0.018606259729593788, - -0.008359161113783348 - ], - "translation_xyz_cm": [ - 0.5715235315443046, - -1.8606259729593788, - -0.8359161113783348 - ], - "translation_norm_m": 0.021183304519412888, - "rotation_rpy_deg_xyz": [ - -1.2720688018710513, - -0.9727792777962608, - 0.15083411684380954 - ], - "rotation_angle_deg": 1.6074549784449825, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.01568057740429052, - -0.0001591465221336824, - 0.0195531389125444 - ], - "translation_xyz_cm": [ - 1.5680577404290519, - -0.01591465221336824, - 1.9553138912544399 - ], - "translation_norm_m": 0.025064538229951725, - "rotation_rpy_deg_xyz": [ - -0.24144636123439234, - -0.36545549873109584, - -0.12628326000494933 - ], - "rotation_angle_deg": 0.4560654940494813, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.007171326178327497, - -0.023897797604079785, - 0.016034431673971755 - ], - "translation_xyz_cm": [ - 0.7171326178327497, - -2.3897797604079782, - 1.6034431673971756 - ], - "translation_norm_m": 0.02965865217080499, - "rotation_rpy_deg_xyz": [ - 1.0082785388777031, - 0.3418167118321031, - -0.19146897481054245 - ], - "rotation_angle_deg": 1.082253344564768, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.00026438639767045746, - 0.02216326709669758, - -0.08346152346674357 - ], - "translation_xyz_cm": [ - 0.026438639767045746, - 2.216326709669758, - -8.346152346674357 - ], - "translation_norm_m": 0.08635453785387667, - "rotation_rpy_deg_xyz": [ - -0.02257885250807086, - 1.5542611810178693, - 0.08681375933694925 - ], - "rotation_angle_deg": 1.556864455164466, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00701273750569964, - 0.02282540605803174, - 0.03260808931243531 - ], - "translation_xyz_cm": [ - -0.701273750569964, - 2.282540605803174, - 3.2608089312435307 - ], - "translation_norm_m": 0.0404161494658464, - "rotation_rpy_deg_xyz": [ - 0.5278203864668309, - 1.113162654102193, - -0.2713241233896586 - ], - "rotation_angle_deg": 1.2625818696828075, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.004349190900353683, - -0.035801031864167054, - -0.07400979849350936 - ], - "translation_xyz_cm": [ - 0.4349190900353683, - -3.5801031864167054, - -7.400979849350936 - ], - "translation_norm_m": 0.08232909338184578, - "rotation_rpy_deg_xyz": [ - 0.21157732953062178, - 0.8118279343706176, - -0.08759423053223533 - ], - "rotation_angle_deg": 0.843661080839947, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.005100399379186715, - 0.03757339112851099, - -0.06798673777512368 - ], - "translation_xyz_cm": [ - 0.5100399379186715, - 3.757339112851099, - -6.798673777512368 - ], - "translation_norm_m": 0.07784581111419359, - "rotation_rpy_deg_xyz": [ - -0.37263227310089414, - 1.5943610364259209, - 0.21106530697423814 - ], - "rotation_angle_deg": 1.6515347626065906, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018981094624364925, - 0.015395856577505529, - -0.08463745888477736 - ], - "translation_xyz_cm": [ - -1.8981094624364925, - 1.539585657750553, - -8.463745888477735 - ], - "translation_norm_m": 0.08809548115179684, - "rotation_rpy_deg_xyz": [ - 0.2921259389520986, - 0.023568302436283415, - 0.35386385173885226 - ], - "rotation_angle_deg": 0.4594233979587677, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.02324308017858323, - 0.014265767465461487, - -0.07298096894336464 - ], - "translation_xyz_cm": [ - -2.324308017858323, - 1.4265767465461487, - -7.298096894336465 - ], - "translation_norm_m": 0.0779100425200694, - "rotation_rpy_deg_xyz": [ - 0.096538827929061, - 0.6802172413805021, - 0.07926546748901266 - ], - "rotation_angle_deg": 0.6915252875068052, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.026986023271163284, - 0.022043628112035085, - -0.05185464149116792 - ], - "translation_xyz_cm": [ - -2.6986023271163284, - 2.2043628112035085, - -5.185464149116791 - ], - "translation_norm_m": 0.062474561515156096, - "rotation_rpy_deg_xyz": [ - 0.41436809529722984, - 0.9555355765615078, - 0.3271388916518868 - ], - "rotation_angle_deg": 1.0906426479514746, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.00519545055562376, - -0.0066136894964132775, - -0.06812188191980995 - ], - "translation_xyz_cm": [ - -0.519545055562376, - -0.6613689496413278, - -6.812188191980995 - ], - "translation_norm_m": 0.06863908792756084, - "rotation_rpy_deg_xyz": [ - 0.6751161714406783, - 0.8865541551089682, - 0.49085684660017875 - ], - "rotation_angle_deg": 1.2155477153397103, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.019735173991315857, - -0.0141790036634446, - -0.024027636200510398 - ], - "translation_xyz_cm": [ - 1.9735173991315857, - -1.41790036634446, - -2.4027636200510396 - ], - "translation_norm_m": 0.03417379900946869, - "rotation_rpy_deg_xyz": [ - -0.5100589622181426, - -0.019253599857902037, - -0.24191615117474688 - ], - "rotation_angle_deg": 0.5648852494728799, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007033357566729126, - -0.001000900711205177, - -0.04624793891777463 - ], - "translation_xyz_cm": [ - -0.7033357566729126, - -0.10009007112051771, - -4.624793891777463 - ], - "translation_norm_m": 0.046790402595376014, - "rotation_rpy_deg_xyz": [ - 0.8220345123345667, - 0.5010295066741716, - 0.27079568189573283 - ], - "rotation_angle_deg": 0.9990740689487144, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.00560101594232254, - 0.001093708737066823, - 0.061871869774071414 - ], - "translation_xyz_cm": [ - 0.560101594232254, - 0.1093708737066823, - 6.1871869774071415 - ], - "translation_norm_m": 0.06213449804840576, - "rotation_rpy_deg_xyz": [ - 1.1003853023292736, - 0.07734496954730145, - -0.26950935986394886 - ], - "rotation_angle_deg": 1.1357214731571688, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.0075057703394882935, - 0.011838342379410838, - -0.00485192143243586 - ], - "translation_xyz_cm": [ - -0.7505770339488294, - 1.1838342379410838, - -0.485192143243586 - ], - "translation_norm_m": 0.014833208697642845, - "rotation_rpy_deg_xyz": [ - 0.9666976963164502, - 1.0419243574625519, - 0.4322689035655956 - ], - "rotation_angle_deg": 1.4830147812866028, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0015905300157896818, - -0.0016758589557088754, - -0.048082718731155646 - ], - "translation_xyz_cm": [ - -0.15905300157896818, - -0.16758589557088754, - -4.808271873115564 - ], - "translation_norm_m": 0.048138198237470245, - "rotation_rpy_deg_xyz": [ - -0.6307301997653827, - 1.057485851749238, - -0.30029280289655313 - ], - "rotation_angle_deg": 1.2660024346619847, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.01151487805274165, - 0.01472314053117385, - 0.15176071287152687 - ], - "translation_xyz_cm": [ - 1.151487805274165, - 1.472314053117385, - 15.176071287152688 - ], - "translation_norm_m": 0.1529074139960003, - "rotation_rpy_deg_xyz": [ - 1.72731183686409, - 0.11705981261910532, - -0.4807118093171391 - ], - "rotation_angle_deg": 1.797239787409076, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.007853648618558307, - 0.004850391148302879, - 0.07259329363806197 - ], - "translation_xyz_cm": [ - 0.7853648618558307, - 0.48503911483028794, - 7.259329363806197 - ], - "translation_norm_m": 0.07317781338723647, - "rotation_rpy_deg_xyz": [ - 1.1623347797258698, - 0.6846978969824419, - 0.19753366910877249 - ], - "rotation_angle_deg": 1.3623843963965074, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014304737745299612, - 0.013649245788543762, - 0.01256546546519001 - ], - "translation_xyz_cm": [ - 1.4304737745299612, - 1.3649245788543762, - 1.2565465465190009 - ], - "translation_norm_m": 0.023426872495379357, - "rotation_rpy_deg_xyz": [ - 0.6571968799958364, - 1.4524100465272776, - -0.49770822677859017 - ], - "rotation_angle_deg": 1.6725335946739113, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008647901809817782, - 0.04350551240143796, - 0.103315415092893 - ], - "translation_xyz_cm": [ - -0.8647901809817782, - 4.350551240143796, - 10.3315415092893 - ], - "translation_norm_m": 0.11243482917157258, - "rotation_rpy_deg_xyz": [ - -1.3281445047857794, - -0.36543335442229663, - 0.622297386073 - ], - "rotation_angle_deg": 1.509790492367418, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.022076749978461763, - 0.02896080589801109, - 0.08885068377741813 - ], - "translation_xyz_cm": [ - 2.2076749978461763, - 2.896080589801109, - 8.885068377741813 - ], - "translation_norm_m": 0.09602372194196879, - "rotation_rpy_deg_xyz": [ - -0.7497534270156178, - -0.07937309552845272, - 0.4984989635621827 - ], - "rotation_angle_deg": 0.9035541294130945, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.006161495675533812, - -0.02893284713399752, - 0.016984910865775957 - ], - "translation_xyz_cm": [ - -0.6161495675533812, - -2.893284713399752, - 1.6984910865775957 - ], - "translation_norm_m": 0.03411100803783501, - "rotation_rpy_deg_xyz": [ - -0.0003048624635469468, - -0.6040373644759786, - -0.12598422932640005 - ], - "rotation_angle_deg": 0.617036072340314, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.02205318657950084, - 0.037665337298739665, - -0.038570987839001945 - ], - "translation_xyz_cm": [ - -2.205318657950084, - 3.7665337298739665, - -3.8570987839001947 - ], - "translation_norm_m": 0.05824724693077383, - "rotation_rpy_deg_xyz": [ - -1.4485939237787209, - -0.35838369397616304, - -0.06956041448179001 - ], - "rotation_angle_deg": 1.4940967322778111, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012295959444070803, - 0.045583503746082554, - 0.0071528340286210745 - ], - "translation_xyz_cm": [ - 1.2295959444070803, - 4.558350374608255, - 0.7152834028621075 - ], - "translation_norm_m": 0.04775153889730001, - "rotation_rpy_deg_xyz": [ - -0.9316192070343444, - 0.16666991053905278, - -0.08210629739150978 - ], - "rotation_angle_deg": 0.949848079850486, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.00157123494184086, - -0.005704191834971117, - 0.0406453351805328 - ], - "translation_xyz_cm": [ - -0.157123494184086, - -0.5704191834971117, - 4.06453351805328 - ], - "translation_norm_m": 0.04107371246515793, - "rotation_rpy_deg_xyz": [ - 0.228035041766842, - -1.1501568258810069, - 0.22976046902385164 - ], - "rotation_angle_deg": 1.1952818646795054, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.018401192467831784, - 0.00867284395891349, - 0.049169377146166836 - ], - "translation_xyz_cm": [ - -1.8401192467831784, - 0.867284395891349, - 4.916937714616684 - ], - "translation_norm_m": 0.05321136866794393, - "rotation_rpy_deg_xyz": [ - -0.9660593345086891, - -0.9799371565001808, - 0.16581232082061634 - ], - "rotation_angle_deg": 1.3850189405603375, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0041163578342112705, - 0.027671516295528442, - -0.03530975963999329 - ], - "translation_xyz_cm": [ - 0.41163578342112705, - 2.767151629552844, - -3.530975963999329 - ], - "translation_norm_m": 0.04504926571817867, - "rotation_rpy_deg_xyz": [ - -0.2989413310353111, - -0.08969056988784666, - 0.09670887967451436 - ], - "rotation_angle_deg": 0.32667664092936033, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.016770647773910907, - 0.026705611036529908, - -0.07978788303788394 - ], - "translation_xyz_cm": [ - 1.6770647773910907, - 2.670561103652991, - -7.978788303788393 - ], - "translation_norm_m": 0.08579365108944867, - "rotation_rpy_deg_xyz": [ - 0.5553363750855089, - 0.05653636204556871, - 0.10018719039812421 - ], - "rotation_angle_deg": 0.5670778767304527, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.009966210040540657, - 0.004456190169118912, - -0.0029536321054115383 - ], - "translation_xyz_cm": [ - -0.9966210040540657, - 0.4456190169118912, - -0.29536321054115383 - ], - "translation_norm_m": 0.011309593980760018, - "rotation_rpy_deg_xyz": [ - 0.014380068161972315, - -0.1464716480738481, - -0.056531664340824614 - ], - "rotation_angle_deg": 0.1576530338139831, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01702274513624058, - 0.032225448534553225, - -0.05789075920935666 - ], - "translation_xyz_cm": [ - 1.702274513624058, - 3.2225448534553225, - -5.789075920935666 - ], - "translation_norm_m": 0.06840755358191268, - "rotation_rpy_deg_xyz": [ - 0.3905437929563333, - 0.35874077362566104, - -0.1471322655002566 - ], - "rotation_angle_deg": 0.5506599918073353, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.022340473251316606, - 0.02555092743430709, - 0.015081833046673751 - ], - "translation_xyz_cm": [ - 2.2340473251316606, - 2.555092743430709, - 1.5081833046673752 - ], - "translation_norm_m": 0.03714038672245834, - "rotation_rpy_deg_xyz": [ - 0.884932951586503, - 0.30601918684811213, - -0.08774654181717532 - ], - "rotation_angle_deg": 0.9406732828349461, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0015521854353093278, - -0.00027612009203104027, - 0.009387887400799518 - ], - "translation_xyz_cm": [ - -0.15521854353093278, - -0.027612009203104027, - 0.9387887400799518 - ], - "translation_norm_m": 0.009519346184528639, - "rotation_rpy_deg_xyz": [ - 0.5813174322167391, - -0.1083159403627815, - 0.00388423539293148 - ], - "rotation_angle_deg": 0.5913387819804041, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.20116401122908956, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.20872780916647726, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_-0.100", - "body_left_rpy_correction_deg_xyz": [ - -0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143983507484, - 0.0011901746480735614, - 0.7136919554572032 - ], - "rotation_rpy_deg_xyz": [ - -0.8895495264961033, - 1.501168742146643, - -0.8377113510014426 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11994299492844523, - "median": 0.06165099289612251, - "p90": 0.19274025972755957, - "p95": 0.24149431450923356, - "max": 0.3871689826726008 - }, - "rotation_deg": { - "rms": 1.2488889095688314, - "median": 0.9790960728799998, - "p90": 1.7239776847767245, - "p95": 2.47213844627829, - "max": 3.1244945617507716 - }, - "normalized_pair_score": { - "rms": 3.4631521547194706, - "median": 2.5922170735901893, - "p90": 5.412779025435884, - "p95": 6.1871511858628825, - "max": 8.460586155504759 - }, - "normalized_global_rms": 3.4631521547194706 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.018383160375365304, - 0.020226742493427374, - 0.08380292165833562 - ], - "translation_xyz_cm": [ - -1.8383160375365304, - 2.0226742493427374, - 8.380292165833563 - ], - "translation_norm_m": 0.08814755456480321, - "rotation_rpy_deg_xyz": [ - 0.43611512597583724, - 0.12965130529341484, - 0.09655412768637514 - ], - "rotation_angle_deg": 0.46500876133584307, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6886059172123598, - "median": 0.7291535778684739, - "p90": 2.3232842191178094, - "p95": 3.7417816215363167, - "max": 5.703566170764175 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.05340926734199069, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.018383160375365304, - 0.020226742493427374, - 0.08380292165833562 - ], - "translation_xyz_cm": [ - -1.8383160375365304, - 2.0226742493427374, - 8.380292165833563 - ], - "translation_norm_m": 0.08814755456480321, - "rotation_rpy_deg_xyz": [ - 0.43611512597583724, - 0.12965130529341484, - 0.09655412768637514 - ], - "rotation_angle_deg": 0.46500876133584307, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.01974619612971973, - -0.024881260990246012, - 0.16498360878518203 - ], - "translation_xyz_cm": [ - 1.9746196129719729, - -2.4881260990246012, - 16.498360878518202 - ], - "translation_norm_m": 0.16801363211906375, - "rotation_rpy_deg_xyz": [ - -0.2724981418045387, - -0.24998111423363997, - -0.35250093175159736 - ], - "rotation_angle_deg": 0.5112936960028652, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.030864496690274912, - 0.0017691267642296893, - 0.1439449591361687 - ], - "translation_xyz_cm": [ - 3.086449669027491, - 0.17691267642296893, - 14.39449591361687 - ], - "translation_norm_m": 0.14722736914774096, - "rotation_rpy_deg_xyz": [ - 0.07857343960506702, - -0.13042744852647845, - -0.3857349632947017 - ], - "rotation_angle_deg": 0.4146172722417423, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0064292318919019, - -0.002829700928391743, - 0.09476191155776331 - ], - "translation_xyz_cm": [ - -0.64292318919019, - -0.2829700928391743, - 9.47619115577633 - ], - "translation_norm_m": 0.09502190332836606, - "rotation_rpy_deg_xyz": [ - 0.7742857787352664, - 0.38186878386083956, - 0.214455519230105 - ], - "rotation_angle_deg": 0.888945226228632, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.015465026612391797, - -0.005680142858354387, - -0.034277700660023044 - ], - "translation_xyz_cm": [ - -1.5465026612391797, - -0.5680142858354387, - -3.4277700660023043 - ], - "translation_norm_m": 0.038031458472578265, - "rotation_rpy_deg_xyz": [ - 0.7654909625952561, - 0.248425766605269, - 0.07111181647181258 - ], - "rotation_angle_deg": 0.8077819265058498, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.031085939216182856, - -0.01859482890273617, - 0.07109695539492854 - ], - "translation_xyz_cm": [ - 3.1085939216182856, - -1.8594828902736171, - 7.109695539492853 - ], - "translation_norm_m": 0.07979273366229976, - "rotation_rpy_deg_xyz": [ - 0.42755415055022744, - 0.09325924629740204, - -0.3420615722090217 - ], - "rotation_angle_deg": 0.5556468273889856, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.0433130726492883, - 0.005152593338561773, - 0.06069168508405816 - ], - "translation_xyz_cm": [ - 4.33130726492883, - 0.5152593338561773, - 6.069168508405816 - ], - "translation_norm_m": 0.07473989643274605, - "rotation_rpy_deg_xyz": [ - 0.8085731717242293, - 0.44979865009963943, - -0.35553662362891686 - ], - "rotation_angle_deg": 0.9923539778510071, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0034232988724573477, - -0.006771306092086871, - -0.004775935918389283 - ], - "translation_xyz_cm": [ - 0.34232988724573477, - -0.6771306092086871, - -0.47759359183892836 - ], - "translation_norm_m": 0.008965440605985933, - "rotation_rpy_deg_xyz": [ - 1.1531681981061186, - 0.5727072912224455, - 0.03613991699362056 - ], - "rotation_angle_deg": 1.287893213474733, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005400348953126937, - 0.018622313134078666, - 0.000914736370557474 - ], - "translation_xyz_cm": [ - 0.5400348953126937, - 1.8622313134078667, - 0.0914736370557474 - ], - "translation_norm_m": 0.01941110656059666, - "rotation_rpy_deg_xyz": [ - 0.41231252234539784, - 0.2728809514561618, - -0.022720530348243922 - ], - "rotation_angle_deg": 0.4950011557642239, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03727381245348907, - -0.004328533332639162, - -0.03657248186741273 - ], - "translation_xyz_cm": [ - -3.727381245348907, - -0.4328533332639162, - -3.6572481867412727 - ], - "translation_norm_m": 0.052398661486452856, - "rotation_rpy_deg_xyz": [ - 0.89096531814474, - 1.0427632605974202, - 0.5845439175175898 - ], - "rotation_angle_deg": 1.4877329224699238, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04774061512246405, - -0.02723551939126667, - -0.046679127479343496 - ], - "translation_xyz_cm": [ - -4.774061512246405, - -2.723551939126667, - -4.667912747934349 - ], - "translation_norm_m": 0.07211019893895805, - "rotation_rpy_deg_xyz": [ - 1.0026721917479147, - 1.6733171736516033, - 0.5054153176808689 - ], - "rotation_angle_deg": 2.0114398708799017, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.032231014524070886, - -0.021454358937080725, - -0.04407725559983317 - ], - "translation_xyz_cm": [ - -3.2231014524070885, - -2.1454358937080724, - -4.407725559983318 - ], - "translation_norm_m": 0.058667983396951603, - "rotation_rpy_deg_xyz": [ - 0.6624445776245308, - 0.5684771078508901, - 0.603430134060256 - ], - "rotation_angle_deg": 1.05931590872231, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03867094013637161, - -0.04240883717157545, - -0.0538124169728294 - ], - "translation_xyz_cm": [ - -3.867094013637161, - -4.240883717157545, - -5.38124169728294 - ], - "translation_norm_m": 0.07867481999810165, - "rotation_rpy_deg_xyz": [ - 0.9270963326410693, - 1.1574767007764586, - 0.5269424697888327 - ], - "rotation_angle_deg": 1.5706732484906527, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.011938860505734304, - -0.014105860226497013, - -0.01028166896400733 - ], - "translation_xyz_cm": [ - -1.1938860505734303, - -1.4105860226497013, - -1.0281668964007329 - ], - "translation_norm_m": 0.021147680714212712, - "rotation_rpy_deg_xyz": [ - 0.47649402191123896, - 0.3975421512089016, - -0.08389980214300967 - ], - "rotation_angle_deg": 0.6264199026640417, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012397842772088885, - -0.013937000861818663, - -0.1915358459263071 - ], - "translation_xyz_cm": [ - 1.2397842772088885, - -1.3937000861818662, - -19.15358459263071 - ], - "translation_norm_m": 0.19244200885755122, - "rotation_rpy_deg_xyz": [ - -0.6606217395329036, - 0.3860717741330911, - 0.3364305338649816 - ], - "rotation_angle_deg": 0.8367510148279567, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0026480835644682177, - 0.008722346112340731, - -0.23698528808205463 - ], - "translation_xyz_cm": [ - 0.26480835644682177, - 0.8722346112340731, - -23.698528808205463 - ], - "translation_norm_m": 0.2371605330479806, - "rotation_rpy_deg_xyz": [ - -0.35102421231773984, - -0.001770038800402147, - 0.4379294968155481 - ], - "rotation_angle_deg": 0.5612468494035582, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0015810890174363657, - -0.0004554714223665157, - -0.024230864728853482 - ], - "translation_xyz_cm": [ - -0.15810890174363657, - -0.04554714223665157, - -2.4230864728853483 - ], - "translation_norm_m": 0.024286665110830805, - "rotation_rpy_deg_xyz": [ - 0.3235573088452677, - 0.30447725546822, - -0.08739711743670554 - ], - "rotation_angle_deg": 0.4529723783590442, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0055918389103670335, - 0.026472745325089253, - -0.2706001570194317 - ], - "translation_xyz_cm": [ - 0.5591838910367033, - 2.6472745325089253, - -27.06001570194317 - ], - "translation_norm_m": 0.27194948039367095, - "rotation_rpy_deg_xyz": [ - -0.5052185641328618, - 0.4296373141257157, - 0.07352811930942954 - ], - "rotation_angle_deg": 0.6674711251646261, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0010381154766401224, - 0.01390657298084863, - -0.17055272441255426 - ], - "translation_xyz_cm": [ - -0.10381154766401224, - 1.390657298084863, - -17.055272441255426 - ], - "translation_norm_m": 0.17112189298964406, - "rotation_rpy_deg_xyz": [ - -0.41629893629023845, - 0.8024899353252776, - 0.2793545673433836 - ], - "rotation_angle_deg": 0.9470788041824121, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.008841732272564795, - 0.024740839767129152, - 0.0022109832445726257 - ], - "translation_xyz_cm": [ - 0.8841732272564795, - 2.4740839767129152, - 0.22109832445726257 - ], - "translation_norm_m": 0.026366149299248347, - "rotation_rpy_deg_xyz": [ - 0.4611168100755976, - -0.6285542050951745, - -0.2426805603419418 - ], - "rotation_angle_deg": 0.8157035544508465, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.013543885154010615, - -0.030050538598645336, - -0.01988669485264541 - ], - "translation_xyz_cm": [ - -1.3543885154010615, - -3.0050538598645335, - -1.9886694852645408 - ], - "translation_norm_m": 0.038496133926615744, - "rotation_rpy_deg_xyz": [ - 0.19858569083648897, - -0.251808829906442, - -0.47566698468673657 - ], - "rotation_angle_deg": 0.5733125195613572, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.006455224310810803, - 0.006146314714153167, - -0.004128287241227227 - ], - "translation_xyz_cm": [ - 0.6455224310810803, - 0.6146314714153167, - -0.4128287241227227 - ], - "translation_norm_m": 0.009822925277857816, - "rotation_rpy_deg_xyz": [ - 0.6158460146647267, - -0.45459926467940137, - -0.4755575136223061 - ], - "rotation_angle_deg": 0.8998625973395585, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01582986962348354, - 0.009972786442785875, - -0.21289807495550042 - ], - "translation_xyz_cm": [ - -1.582986962348354, - 0.9972786442785875, - -21.289807495550043 - ], - "translation_norm_m": 0.213718580290736, - "rotation_rpy_deg_xyz": [ - -0.471360354936975, - 1.374782543273745, - -0.634766161247169 - ], - "rotation_angle_deg": 1.5836427013820595, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.024909722718722285, - 0.024007787762001076, - -0.23738369980349572 - ], - "translation_xyz_cm": [ - -2.4909722718722285, - 2.4007787762001076, - -23.73836998034957 - ], - "translation_norm_m": 0.2398914110416317, - "rotation_rpy_deg_xyz": [ - -0.03768137042290182, - 1.3350275721601703, - -0.4024427422950545 - ], - "rotation_angle_deg": 1.394746544225359, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011901865284235869, - 0.029625222172632082, - -0.03867244792091767 - ], - "translation_xyz_cm": [ - 1.1901865284235869, - 2.962522217263208, - -3.8672447920917667 - ], - "translation_norm_m": 0.050148443786602194, - "rotation_rpy_deg_xyz": [ - 0.4158916158862899, - -0.08129523149811123, - -0.00973345749763284 - ], - "rotation_angle_deg": 0.4238675711829975, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.013564730960120897, - 0.04319551807458599, - -0.1430143562448163 - ], - "translation_xyz_cm": [ - 1.3564730960120897, - 4.319551807458599, - -14.301435624481629 - ], - "translation_norm_m": 0.15000986900824748, - "rotation_rpy_deg_xyz": [ - -0.3982175221996884, - -0.18855864562415225, - 0.16648686910976102 - ], - "rotation_angle_deg": 0.47077698654335376, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006275450415989203, - 0.01762715007510507, - -0.090847443591143 - ], - "translation_xyz_cm": [ - 0.6275450415989203, - 1.762715007510507, - -9.0847443591143 - ], - "translation_norm_m": 0.09275427593776864, - "rotation_rpy_deg_xyz": [ - -0.6716243905847892, - -0.10093267993094156, - 0.16375154412004647 - ], - "rotation_angle_deg": 0.6984891729323048, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.009188525961397742, - -0.0265834860869143, - -0.1784027846407032 - ], - "translation_xyz_cm": [ - -0.9188525961397742, - -2.65834860869143, - -17.84027846407032 - ], - "translation_norm_m": 0.18060637948154978, - "rotation_rpy_deg_xyz": [ - -0.6919240822219869, - 2.3825206729569697, - -0.3693648483412849 - ], - "rotation_angle_deg": 2.5061676626817344, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.00463178666205305, - 0.01973533854384557, - -0.026080219659917532 - ], - "translation_xyz_cm": [ - 0.463178666205305, - 1.973533854384557, - -2.608021965991753 - ], - "translation_norm_m": 0.033032028285173744, - "rotation_rpy_deg_xyz": [ - 1.098546185735919, - 0.1463982230211785, - 0.2232164133896982 - ], - "rotation_angle_deg": 1.1302358012013523, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.008723924441368158, - 0.034602035178666224, - 0.0476628479758385 - ], - "translation_xyz_cm": [ - 0.8723924441368158, - 3.4602035178666224, - 4.76628479758385 - ], - "translation_norm_m": 0.059541202316817955, - "rotation_rpy_deg_xyz": [ - 1.316696413072637, - 1.7075017541363458, - 0.16329913162190152 - ], - "rotation_angle_deg": 2.1608746012346214, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.008553238118132356, - 0.0030684457392999853, - -0.04178430937121403 - ], - "translation_xyz_cm": [ - -0.8553238118132356, - 0.30684457392999853, - -4.178430937121403 - ], - "translation_norm_m": 0.04276098398294671, - "rotation_rpy_deg_xyz": [ - 0.01484382263785402, - 2.824622952403814, - 0.698881692526806 - ], - "rotation_angle_deg": 2.909732010953458, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015403635005581284, - 0.002745079301746056, - 0.3868527028624443 - ], - "translation_xyz_cm": [ - 1.5403635005581284, - 0.2745079301746056, - 38.685270286244425 - ], - "translation_norm_m": 0.3871689826726008, - "rotation_rpy_deg_xyz": [ - -1.3870403812274958, - 0.989023065221046, - -0.07147955968566132 - ], - "rotation_angle_deg": 1.7045226338497335, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.011813389004923236, - 0.03598090477454441, - 0.04056480185467598 - ], - "translation_xyz_cm": [ - 1.1813389004923236, - 3.598090477454441, - 4.056480185467598 - ], - "translation_norm_m": 0.055494908033851154, - "rotation_rpy_deg_xyz": [ - 1.5180051936146637, - -0.31660681329101953, - 0.06125379849235318 - ], - "rotation_angle_deg": 1.5520436169297331, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0026905174216846905, - 0.014480171952803378, - -0.007331672982709378 - ], - "translation_xyz_cm": [ - -0.26905174216846905, - 1.4480171952803378, - -0.7331672982709379 - ], - "translation_norm_m": 0.016451981415760628, - "rotation_rpy_deg_xyz": [ - 0.27727617115147324, - 2.405112114744414, - 0.49699373186889906 - ], - "rotation_angle_deg": 2.470347434888635, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03601988712329063, - 0.022268497406034538, - 0.14292402965639908 - ], - "translation_xyz_cm": [ - 3.601988712329063, - 2.2268497406034538, - 14.292402965639909 - ], - "translation_norm_m": 0.14906574555651747, - "rotation_rpy_deg_xyz": [ - 0.014123071198875644, - -0.3626806570705012, - -0.290622763704574 - ], - "rotation_angle_deg": 0.4649430573110449, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.012091839805618648, - 0.010185474992960408, - 0.38645868015714 - ], - "translation_xyz_cm": [ - 1.209183980561865, - 1.0185474992960408, - 38.645868015714 - ], - "translation_norm_m": 0.38678193851253656, - "rotation_rpy_deg_xyz": [ - -0.6128271006668816, - 0.9595576952030676, - -0.24430410787403065 - ], - "rotation_angle_deg": 1.1633891945659212, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.013150577338937097, - 0.008901360747302745, - 0.05584823113100784 - ], - "translation_xyz_cm": [ - -1.3150577338937097, - 0.8901360747302745, - 5.584823113100784 - ], - "translation_norm_m": 0.05806200847338526, - "rotation_rpy_deg_xyz": [ - 1.0865760881187878, - 2.8717158599832717, - 0.6070089308688793 - ], - "rotation_angle_deg": 3.1244945617507716, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.037697136629159744, - 0.0007617886279895902, - 0.18332928683753374 - ], - "translation_xyz_cm": [ - 3.7697136629159744, - 0.07617886279895902, - 18.332928683753373 - ], - "translation_norm_m": 0.18716645491195796, - "rotation_rpy_deg_xyz": [ - 0.4001094253563266, - 0.15189580606135955, - -0.21472107663884038 - ], - "rotation_angle_deg": 0.47905373429493425, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.04227075507644429, - 0.008491082468136124, - 0.3192979563120227 - ], - "translation_xyz_cm": [ - 4.227075507644429, - 0.8491082468136124, - 31.929795631202268 - ], - "translation_norm_m": 0.3221957481427211, - "rotation_rpy_deg_xyz": [ - 0.140129787234191, - 0.46651647916316913, - -0.22962702094951257 - ], - "rotation_angle_deg": 0.5387616571128419, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.028457597870528817, - 0.01718729960738452, - 0.06358752799392567 - ], - "translation_xyz_cm": [ - 2.8457597870528817, - 1.718729960738452, - 6.358752799392567 - ], - "translation_norm_m": 0.07175382819566499, - "rotation_rpy_deg_xyz": [ - 1.0146894633690535, - -2.2697954038441774, - -0.7866514923031432 - ], - "rotation_angle_deg": 2.6016405221161247, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.009602883251383698, - 0.022788005907503184, - 0.1938536393330133 - ], - "translation_xyz_cm": [ - -0.9602883251383698, - 2.2788005907503184, - 19.38536393330133 - ], - "translation_norm_m": 0.19542451755763426, - "rotation_rpy_deg_xyz": [ - 0.8478994091990286, - -0.5280098552887685, - -0.7257131224523831 - ], - "rotation_angle_deg": 1.2323547901972325, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.002525272838777015, - -0.022331831283203263, - 0.1574854333356639 - ], - "translation_xyz_cm": [ - -0.2525272838777015, - -2.2331831283203263, - 15.748543333566388 - ], - "translation_norm_m": 0.1590809523616626, - "rotation_rpy_deg_xyz": [ - -0.9290330862858384, - 0.575236441403683, - -0.023587475030967867 - ], - "rotation_angle_deg": 1.0928533909972689, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.005783734161657839, - -0.010037778062560232, - -0.06708301364278785 - ], - "translation_xyz_cm": [ - 0.5783734161657839, - -1.0037778062560232, - -6.7083013642787845 - ], - "translation_norm_m": 0.06807598173133021, - "rotation_rpy_deg_xyz": [ - -0.26515893122308604, - 0.5157167231757456, - 0.09241565067721615 - ], - "rotation_angle_deg": 0.5873956666347905, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0016650311863690703, - 0.026415500106281353, - 0.049300828073751954 - ], - "translation_xyz_cm": [ - 0.16650311863690703, - 2.6415500106281353, - 4.930082807375196 - ], - "translation_norm_m": 0.055956435049725785, - "rotation_rpy_deg_xyz": [ - -0.6764235516207044, - 0.09962187000298273, - -0.714219295344651 - ], - "rotation_angle_deg": 0.9882997346253057, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014835218099596315, - -0.0457960705383067, - -0.006909120647785347 - ], - "translation_xyz_cm": [ - 1.4835218099596315, - -4.57960705383067, - -0.6909120647785347 - ], - "translation_norm_m": 0.0486322909283308, - "rotation_rpy_deg_xyz": [ - 0.32122060043667044, - 0.383700432612446, - -0.6217470840523832 - ], - "rotation_angle_deg": 0.7989447842410625, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.014312476620598868, - -0.012328612772887215, - -0.004129839593904956 - ], - "translation_xyz_cm": [ - -1.4312476620598868, - -1.2328612772887215, - -0.4129839593904956 - ], - "translation_norm_m": 0.01933642301436261, - "rotation_rpy_deg_xyz": [ - 0.15052408267679532, - -0.10129121554981338, - -0.7103753330325546 - ], - "rotation_angle_deg": 0.7330491529741734, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.01225787659023636, - 0.01948550162212248, - -0.060574105902566754 - ], - "translation_xyz_cm": [ - 1.225787659023636, - 1.948550162212248, - -6.0574105902566755 - ], - "translation_norm_m": 0.06480094611857588, - "rotation_rpy_deg_xyz": [ - 0.6437912603382372, - 0.2677570555647682, - 0.14842919191732146 - ], - "rotation_angle_deg": 0.7125620419024886, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.012424251267699027, - 0.007726526424359115, - 0.006348566974552633 - ], - "translation_xyz_cm": [ - 1.2424251267699027, - 0.7726526424359115, - 0.6348566974552633 - ], - "translation_norm_m": 0.015948841110865104, - "rotation_rpy_deg_xyz": [ - 0.7873504339826362, - 0.9388026407654373, - 0.016821677162246456 - ], - "rotation_angle_deg": 1.2252849375043278, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.004914677295266401, - -0.018755291912151528, - -0.005288428938430151 - ], - "translation_xyz_cm": [ - 0.4914677295266401, - -1.8755291912151528, - -0.5288428938430151 - ], - "translation_norm_m": 0.020096828313528707, - "rotation_rpy_deg_xyz": [ - -1.2561670541308172, - -1.0254625640178576, - 0.1515495149630793 - ], - "rotation_angle_deg": 1.6275888689576745, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.014274271851217657, - -0.001097051355249276, - 0.021882888341659662 - ], - "translation_xyz_cm": [ - 1.4274271851217657, - -0.10970513552492761, - 2.188288834165966 - ], - "translation_norm_m": 0.026149936151586745, - "rotation_rpy_deg_xyz": [ - -0.16558707856637964, - -0.46106111097196373, - -0.12552416337510086 - ], - "rotation_angle_deg": 0.5058851246418364, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.006820829987379096, - -0.026498349273415933, - 0.018035255682317397 - ], - "translation_xyz_cm": [ - 0.6820829987379096, - -2.649834927341593, - 1.8035255682317397 - ], - "translation_norm_m": 0.03277127833117339, - "rotation_rpy_deg_xyz": [ - 1.2054507756128874, - 0.3197284865960237, - -0.18709088567022752 - ], - "rotation_angle_deg": 1.261584022663077, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0014658667717785123, - 0.020766054194460537, - -0.08232717434180561 - ], - "translation_xyz_cm": [ - 0.14658667717785123, - 2.0766054194460537, - -8.232717434180561 - ], - "translation_norm_m": 0.08491843973664337, - "rotation_rpy_deg_xyz": [ - 0.08725621173951228, - 1.6551833073807352, - 0.0914016668709136 - ], - "rotation_angle_deg": 1.659930174627369, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007949669485065591, - 0.02249596932473752, - 0.034948730517374536 - ], - "translation_xyz_cm": [ - -0.7949669485065591, - 2.249596932473752, - 3.4948730517374536 - ], - "translation_norm_m": 0.04231642288234416, - "rotation_rpy_deg_xyz": [ - 0.555977593671294, - 1.0450296565965698, - -0.2723480788306397 - ], - "rotation_angle_deg": 1.2157804517210966, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0030886067672835082, - -0.03717269686917579, - -0.06829181710553196 - ], - "translation_xyz_cm": [ - 0.3088606767283508, - -3.717269686917579, - -6.829181710553196 - ], - "translation_norm_m": 0.0778146590808311, - "rotation_rpy_deg_xyz": [ - 0.31373856094791497, - 0.7132828974610909, - -0.08698587602743489 - ], - "rotation_angle_deg": 0.7842890272884411, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.005275981817377096, - 0.03516698759028447, - -0.061160698259027896 - ], - "translation_xyz_cm": [ - 0.5275981817377096, - 3.516698759028447, - -6.116069825902789 - ], - "translation_norm_m": 0.07074732512147985, - "rotation_rpy_deg_xyz": [ - -0.1738444562776752, - 1.611723347630678, - 0.21647269531498173 - ], - "rotation_angle_deg": 1.6357835899280908, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.018104110190204192, - 0.01468678048241745, - -0.08214129596543168 - ], - "translation_xyz_cm": [ - -1.8104110190204192, - 1.468678048241745, - -8.214129596543168 - ], - "translation_norm_m": 0.08538531975461834, - "rotation_rpy_deg_xyz": [ - 0.336497026304798, - 0.1080996496799795, - 0.35687647369402176 - ], - "rotation_angle_deg": 0.5020454101375263, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.024339599743979923, - 0.013426304233686404, - -0.07089262717009574 - ], - "translation_xyz_cm": [ - -2.4339599743979923, - 1.3426304233686404, - -7.089262717009574 - ], - "translation_norm_m": 0.0761475301513506, - "rotation_rpy_deg_xyz": [ - 0.15843915553791005, - 0.5891964511392171, - 0.07919183076452443 - ], - "rotation_angle_deg": 0.6151401975848523, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02810633736180157, - 0.020582066671667176, - -0.050650461528904414 - ], - "translation_xyz_cm": [ - -2.810633736180157, - 2.0582066671667176, - -5.065046152890441 - ], - "translation_norm_m": 0.06147403453055104, - "rotation_rpy_deg_xyz": [ - 0.5295589134882894, - 0.8581230040956312, - 0.3277565683019614 - ], - "rotation_angle_deg": 1.0590677833101425, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.004548522759719065, - -0.008850503366848672, - -0.0671133756196416 - ], - "translation_xyz_cm": [ - -0.4548522759719065, - -0.8850503366848672, - -6.711337561964161 - ], - "translation_norm_m": 0.06784707551696967, - "rotation_rpy_deg_xyz": [ - 0.8586651949486858, - 0.9428412453899507, - 0.49734179823209307 - ], - "rotation_angle_deg": 1.3662174589355929, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.02082604402472077, - -0.01596320817288932, - -0.02524584201105609 - ], - "translation_xyz_cm": [ - 2.082604402472077, - -1.596320817288932, - -2.524584201105609 - ], - "translation_norm_m": 0.03641291891263062, - "rotation_rpy_deg_xyz": [ - -0.3643273960369011, - 0.07107132920745363, - -0.2373068459941948 - ], - "rotation_angle_deg": 0.44044598565957693, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007679097452363559, - -0.0012513505442734996, - -0.04512878817955977 - ], - "translation_xyz_cm": [ - -0.7679097452363559, - -0.12513505442734996, - -4.512878817955977 - ], - "translation_norm_m": 0.04579456232374236, - "rotation_rpy_deg_xyz": [ - 0.837180795046171, - 0.44955107953413675, - 0.2696027779099811 - ], - "rotation_angle_deg": 0.9868522323306123, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0045099286090297674, - -0.0008634461424636974, - 0.06165720202797825 - ], - "translation_xyz_cm": [ - 0.45099286090297674, - -0.08634461424636974, - 6.165720202797825 - ], - "translation_norm_m": 0.06182795126169398, - "rotation_rpy_deg_xyz": [ - 1.2544689349475062, - -0.005353668423077865, - -0.26852759648704694 - ], - "rotation_angle_deg": 1.2828849063656524, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.00821444296680518, - 0.009386397170338956, - 0.00013862695131117153 - ], - "translation_xyz_cm": [ - -0.821444296680518, - 0.9386397170338956, - 0.013862695131117153 - ], - "translation_norm_m": 0.012474002666581087, - "rotation_rpy_deg_xyz": [ - 1.1501342482729793, - 0.9881695610802023, - 0.43520052104662854 - ], - "rotation_angle_deg": 1.574805009328298, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0017359725834311668, - -0.004222849997788547, - -0.043376468105019925 - ], - "translation_xyz_cm": [ - -0.17359725834311668, - -0.4222849997788547, - -4.337646810501992 - ], - "translation_norm_m": 0.04361609849791769, - "rotation_rpy_deg_xyz": [ - -0.4309650438918858, - 1.051867826060546, - -0.2951018112873353 - ], - "rotation_angle_deg": 1.17341338992718, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.010301220532728639, - 0.013626730855293534, - 0.14725943493441151 - ], - "translation_xyz_cm": [ - 1.0301220532728639, - 1.3626730855293534, - 14.725943493441152 - ], - "translation_norm_m": 0.14824690254932377, - "rotation_rpy_deg_xyz": [ - 1.8301387437709133, - 0.018549493182749403, - -0.4826924518113873 - ], - "rotation_angle_deg": 1.8928840601692314, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.006651957958649035, - 0.002899392877248941, - 0.07685516198279276 - ], - "translation_xyz_cm": [ - 0.6651957958649035, - 0.2899392877248941, - 7.6855161982792755 - ], - "translation_norm_m": 0.07719696203311105, - "rotation_rpy_deg_xyz": [ - 1.3052314429480985, - 0.5957802491571287, - 0.19790480543908814 - ], - "rotation_angle_deg": 1.4474274183836051, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.013519147006409327, - 0.011194870971349635, - 0.017756801534225097 - ], - "translation_xyz_cm": [ - 1.3519147006409327, - 1.1194870971349635, - 1.7756801534225097 - ], - "translation_norm_m": 0.024967908854606383, - "rotation_rpy_deg_xyz": [ - 0.8389369411026477, - 1.3961496053312874, - -0.49460441832016233 - ], - "rotation_angle_deg": 1.7052103097331108, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007839204250768894, - 0.043423515574631866, - 0.09805126246796457 - ], - "translation_xyz_cm": [ - -0.7839204250768894, - 4.342351557463187, - 9.805126246796457 - ], - "translation_norm_m": 0.10752257855774873, - "rotation_rpy_deg_xyz": [ - -1.316079143796051, - -0.3163232883577467, - 0.6222855239448442 - ], - "rotation_angle_deg": 1.4882271746649507, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.023613222760893393, - 0.028182539110582994, - 0.08019127409409789 - ], - "translation_xyz_cm": [ - 2.3613222760893393, - 2.8182539110582994, - 8.019127409409789 - ], - "translation_norm_m": 0.08821836679915271, - "rotation_rpy_deg_xyz": [ - -0.6785471749775992, - 0.017857475589777454, - 0.5007466762683165 - ], - "rotation_angle_deg": 0.8435611153574101, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.005178229805556489, - -0.029228319966351946, - 0.014278792750043387 - ], - "translation_xyz_cm": [ - -0.5178229805556489, - -2.9228319966351943, - 1.4278792750043388 - ], - "translation_norm_m": 0.03293922698505982, - "rotation_rpy_deg_xyz": [ - 0.02771499512348203, - -0.5331373487874171, - -0.1240698794261811 - ], - "rotation_angle_deg": 0.5480554493427504, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.021570843223719383, - 0.03522258971857006, - -0.042018843140520415 - ], - "translation_xyz_cm": [ - -2.1570843223719383, - 3.5222589718570063, - -4.201884314052042 - ], - "translation_norm_m": 0.058919566213038746, - "rotation_rpy_deg_xyz": [ - -1.2526552738736987, - -0.3290520195788681, - -0.06463753331703133 - ], - "rotation_angle_deg": 1.2969421700134667, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012176037477120705, - 0.043097110920172876, - 0.004831211918958189 - ], - "translation_xyz_cm": [ - 1.2176037477120705, - 4.309711092017288, - 0.4831211918958189 - ], - "translation_norm_m": 0.04504395039198734, - "rotation_rpy_deg_xyz": [ - -0.7329927866892773, - 0.15201291191683952, - -0.07693135182588791 - ], - "rotation_angle_deg": 0.7524325711771519, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0006574171602262702, - -0.00588677820775696, - 0.03787331539201208 - ], - "translation_xyz_cm": [ - -0.06574171602262702, - -0.588677820775696, - 3.787331539201208 - ], - "translation_norm_m": 0.038333723713888025, - "rotation_rpy_deg_xyz": [ - 0.2489415722240088, - -1.087458460884607, - 0.23159880429972513 - ], - "rotation_angle_deg": 1.139853731841261, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.016949508793877577, - 0.007492673967253949, - 0.04459144492098576 - ], - "translation_xyz_cm": [ - -1.6949508793877577, - 0.7492673967253949, - 4.459144492098576 - ], - "translation_norm_m": 0.04828895289478335, - "rotation_rpy_deg_xyz": [ - -0.8699452096998221, - -0.8785478452332731, - 0.1683694626646869 - ], - "rotation_angle_deg": 1.2468910909147883, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0051819201192959685, - 0.025823227293718, - -0.0348984380211636 - ], - "translation_xyz_cm": [ - 0.5181920119295969, - 2.5823227293718, - -3.4898438021163605 - ], - "translation_norm_m": 0.04372176048951808, - "rotation_rpy_deg_xyz": [ - -0.1505180419534615, - -0.0008268877992166305, - 0.10170575379174247 - ], - "rotation_angle_deg": 0.1816595666901165, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.017433864887000494, - 0.024362706193154504, - -0.07715604507630527 - ], - "translation_xyz_cm": [ - 1.7433864887000494, - 2.4362706193154504, - -7.715604507630528 - ], - "translation_norm_m": 0.08276796717190177, - "rotation_rpy_deg_xyz": [ - 0.7366193885281924, - 0.11600342983705686, - 0.10658325345242668 - ], - "rotation_angle_deg": 0.7531703700077245, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.00895220653760509, - 0.004056381139962317, - -0.0055553932570644796 - ], - "translation_xyz_cm": [ - -0.895220653760509, - 0.40563811399623173, - -0.5555393257064479 - ], - "translation_norm_m": 0.01128975748566898, - "rotation_rpy_deg_xyz": [ - 0.04901888781962356, - -0.0693287941384343, - -0.054316280232607185 - ], - "rotation_angle_deg": 0.10077881141139919, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.018173268174098034, - 0.03110993497452319, - -0.056086430200589885 - ], - "translation_xyz_cm": [ - 1.8173268174098034, - 3.110993497452319, - -5.608643020058988 - ], - "translation_norm_m": 0.06666170852065215, - "rotation_rpy_deg_xyz": [ - 0.4738420548919203, - 0.45871908510390336, - -0.14255640227476335 - ], - "rotation_angle_deg": 0.6751379162031433, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.02294948061883284, - 0.025295281539718273, - 0.01599263575951576 - ], - "translation_xyz_cm": [ - 2.294948061883284, - 2.5295281539718273, - 1.599263575951576 - ], - "translation_norm_m": 0.037713317639586394, - "rotation_rpy_deg_xyz": [ - 0.8986292858445909, - 0.3579651135625417, - -0.08572696521113927 - ], - "rotation_angle_deg": 0.9713399134293872, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0009922306622260901, - -0.00036252837557104733, - 0.008818703554905735 - ], - "translation_xyz_cm": [ - -0.09922306622260901, - -0.03625283755710473, - 0.8818703554905735 - ], - "translation_norm_m": 0.008881749878231364, - "rotation_rpy_deg_xyz": [ - 0.5903725616414294, - -0.06525756827513168, - 0.005268191107037877 - ], - "rotation_angle_deg": 0.5939945875625879, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.16691653749473545, - "improved_pairs": 30, - "worsened_pairs": 50, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.15210042200009888, - "global_consistency_signal": false - } - }, - { - "label": "pitch_+0.300_roll_+0.100", - "body_left_rpy_correction_deg_xyz": [ - 0.1, - 0.3, - 0.0 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.3015143971201475, - -0.0013248359682619102, - 0.713691720431845 - ], - "rotation_rpy_deg_xyz": [ - -0.6895047465055957, - 1.5040854381408757, - -0.833512808459901 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11828455597352863, - "median": 0.06064218541394156, - "p90": 0.19320239669419764, - "p95": 0.24675995807588086, - "max": 0.3804961703345569 - }, - "rotation_deg": { - "rms": 1.2562925755921872, - "median": 0.9714409961384207, - "p90": 1.889037735619183, - "p95": 2.321355654318161, - "max": 3.0082230046105485 - }, - "normalized_pair_score": { - "rms": 3.4510257337050003, - "median": 2.729131736618827, - "p90": 5.50713646037435, - "p95": 5.953269146769303, - "max": 8.105016273412474 - }, - "normalized_global_rms": 3.4510257337050003 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01904833255769539, - 0.020381158607174377, - 0.08520565515238204 - ], - "translation_xyz_cm": [ - -1.904833255769539, - 2.0381158607174377, - 8.520565515238204 - ], - "translation_norm_m": 0.0896562003954328, - "rotation_rpy_deg_xyz": [ - 0.4420597349964467, - 0.08407650715886328, - 0.09573271328207696 - ], - "rotation_angle_deg": 0.45998721539756443, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6556931398905776, - "median": 0.7038478902798858, - "p90": 2.246336260565, - "p95": 3.6834655103174776, - "max": 5.511875843494262 - }, - "height_residual_m": { - "rms": 0.034713965171217304, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01904833255769539, - 0.020381158607174377, - 0.08520565515238204 - ], - "translation_xyz_cm": [ - -1.904833255769539, - 2.0381158607174377, - 8.520565515238204 - ], - "translation_norm_m": 0.0896562003954328, - "rotation_rpy_deg_xyz": [ - 0.4420597349964467, - 0.08407650715886328, - 0.09573271328207696 - ], - "rotation_angle_deg": 0.45998721539756443, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.018395996351270538, - -0.02478088929211708, - 0.1666614877492215 - ], - "translation_xyz_cm": [ - 1.8395996351270538, - -2.478088929211708, - 16.66614877492215 - ], - "translation_norm_m": 0.16949500480736307, - "rotation_rpy_deg_xyz": [ - -0.2505019709895727, - -0.33830388154870406, - -0.352737931338298 - ], - "rotation_angle_deg": 0.5496778985680154, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.028842156861251245, - 0.0014170674000499872, - 0.14614950167851626 - ], - "translation_xyz_cm": [ - 2.8842156861251245, - 0.14170674000499872, - 14.614950167851626 - ], - "translation_norm_m": 0.1489750144598212, - "rotation_rpy_deg_xyz": [ - 0.13126176780087295, - -0.2628302878447186, - -0.3864198586018625 - ], - "rotation_angle_deg": 0.485176963852399, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.00909685784801248, - -0.004520166818993143, - 0.09671362229635905 - ], - "translation_xyz_cm": [ - -0.909685784801248, - -0.4520166818993143, - 9.671362229635905 - ], - "translation_norm_m": 0.09724561413483526, - "rotation_rpy_deg_xyz": [ - 0.9116234692787093, - 0.1948051945382892, - 0.21272851314623326 - ], - "rotation_angle_deg": 0.9558235612882696, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.018235777166651257, - -0.008252835301808537, - -0.0321989196625788 - ], - "translation_xyz_cm": [ - -1.8235777166651257, - -0.8252835301808537, - -3.2198919662578795 - ], - "translation_norm_m": 0.037913365543403556, - "rotation_rpy_deg_xyz": [ - 0.9657755289895806, - 0.051276037831366306, - 0.07067101806950862 - ], - "rotation_angle_deg": 0.9696828012049435, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03046023592467695, - -0.01852607149636737, - 0.07198919397914268 - ], - "translation_xyz_cm": [ - 3.046023592467695, - -1.852607149636737, - 7.198919397914268 - ], - "translation_norm_m": 0.08033358791590307, - "rotation_rpy_deg_xyz": [ - 0.43342307969089017, - 0.04799033520751327, - -0.3428716287633717 - ], - "rotation_angle_deg": 0.5548364502319297, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04200641327754229, - 0.004950676136662557, - 0.06222348241584189 - ], - "translation_xyz_cm": [ - 4.200641327754228, - 0.49506761366625573, - 6.222348241584189 - ], - "translation_norm_m": 0.07523835268404264, - "rotation_rpy_deg_xyz": [ - 0.8342492561734963, - 0.35461963286390613, - -0.35753928233370813 - ], - "rotation_angle_deg": 0.9753986235240503, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - 0.0010006029460010168, - -0.008775633066654853, - -0.003018605597079463 - ], - "translation_xyz_cm": [ - 0.10006029460010168, - -0.8775633066654853, - -0.3018605597079463 - ], - "translation_norm_m": 0.009334073158425075, - "rotation_rpy_deg_xyz": [ - 1.3077732583891837, - 0.3807997116092954, - 0.03342988464704454 - ], - "rotation_angle_deg": 1.3623875957405787, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004716346879266558, - 0.018521576774170267, - 0.0016242465236754038 - ], - "translation_xyz_cm": [ - 0.47163468792665575, - 1.8521576774170267, - 0.1624246523675404 - ], - "translation_norm_m": 0.019181525248444724, - "rotation_rpy_deg_xyz": [ - 0.4202947050189126, - 0.21977073971276528, - -0.02362891009803742 - ], - "rotation_angle_deg": 0.4749136928900865, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.03893427370808335, - -0.005207541117796588, - -0.0357413547420142 - ], - "translation_xyz_cm": [ - -3.8934273708083347, - -0.5207541117796588, - -3.5741354742014204 - ], - "translation_norm_m": 0.05310782044542963, - "rotation_rpy_deg_xyz": [ - 0.9505937044481167, - 0.9031485077857452, - 0.5819407555830084 - ], - "rotation_angle_deg": 1.4315052553288736, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04978082088432592, - -0.028773295112365815, - -0.04534872185959497 - ], - "translation_xyz_cm": [ - -4.9780820884325925, - -2.8773295112365815, - -4.534872185959498 - ], - "translation_norm_m": 0.07322936032657626, - "rotation_rpy_deg_xyz": [ - 1.1142400264138697, - 1.4967786939588303, - 0.5026484786713454 - ], - "rotation_angle_deg": 1.9286805626935815, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03338090642334224, - -0.021933877687295045, - -0.04376170168621364 - ], - "translation_xyz_cm": [ - -3.338090642334224, - -2.1933877687295045, - -4.376170168621364 - ], - "translation_norm_m": 0.059249189349039236, - "rotation_rpy_deg_xyz": [ - 0.6892336580734498, - 0.47133763021599745, - 0.6016485125104645 - ], - "rotation_angle_deg": 1.0275031644702695, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04036435847028008, - -0.04342200836353177, - -0.052847979274865994 - ], - "translation_xyz_cm": [ - -4.036435847028008, - -4.342200836353177, - -5.2847979274866 - ], - "translation_norm_m": 0.07942078543099759, - "rotation_rpy_deg_xyz": [ - 0.9941285277211087, - 1.0109267062779146, - 0.5242246664847344 - ], - "rotation_angle_deg": 1.5085890964108983, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.01272450901205796, - -0.014307019952286892, - -0.009483539072524794 - ], - "translation_xyz_cm": [ - -1.272450901205796, - -1.4307019952286892, - -0.9483539072524795 - ], - "translation_norm_m": 0.021366830903369455, - "rotation_rpy_deg_xyz": [ - 0.4875624959163362, - 0.3347642874741043, - -0.08500266890615507 - ], - "rotation_angle_deg": 0.5977049238860668, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.01077010557728375, - -0.016039796021620728, - -0.1927376278264234 - ], - "translation_xyz_cm": [ - 1.077010557728375, - -1.603979602162073, - -19.27376278264234 - ], - "translation_norm_m": 0.1937035451681717, - "rotation_rpy_deg_xyz": [ - -0.508985809053043, - 0.1948992809232512, - 0.3397247662974838 - ], - "rotation_angle_deg": 0.6426914299473087, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0012204221540204063, - 0.007165518523702476, - -0.23876574217234386 - ], - "translation_xyz_cm": [ - 0.12204221540204063, - 0.7165518523702477, - -23.876574217234385 - ], - "translation_norm_m": 0.23887635655513864, - "rotation_rpy_deg_xyz": [ - -0.2580102449027787, - -0.16788049638166663, - 0.4389633890122985 - ], - "rotation_angle_deg": 0.5358261308849372, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.0036239062429221924, - -0.0028752428866894997, - -0.022214078412385194 - ], - "translation_xyz_cm": [ - -0.36239062429221924, - -0.28752428866894997, - -2.2214078412385194 - ], - "translation_norm_m": 0.022690636787594722, - "rotation_rpy_deg_xyz": [ - 0.5113019206865893, - 0.10770719723327965, - -0.08661686048764379 - ], - "rotation_angle_deg": 0.5297321015043762, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004242608452004734, - 0.023267798901436487, - -0.27217852408175885 - ], - "translation_xyz_cm": [ - 0.4242608452004734, - 2.3267798901436487, - -27.217852408175887 - ], - "translation_norm_m": 0.273204207807126, - "rotation_rpy_deg_xyz": [ - -0.21782937726971008, - 0.25264984511790756, - 0.07974406842707166 - ], - "rotation_angle_deg": 0.34309940301422276, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0018672650277911096, - 0.013221419550220381, - -0.16964377660612132 - ], - "translation_xyz_cm": [ - -0.18672650277911096, - 1.3221419550220381, - -16.964377660612133 - ], - "translation_norm_m": 0.17016845640363126, - "rotation_rpy_deg_xyz": [ - -0.3974111392144472, - 0.7205017968983465, - 0.279302455793239 - ], - "rotation_angle_deg": 0.8697474953567486, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.006892704756483348, - 0.023500413578351864, - 0.006142946314064465 - ], - "translation_xyz_cm": [ - 0.6892704756483348, - 2.3500413578351864, - 0.6142946314064466 - ], - "translation_norm_m": 0.025249051598646453, - "rotation_rpy_deg_xyz": [ - 0.5433912417114122, - -0.7873485459473497, - -0.24410313035982267 - ], - "rotation_angle_deg": 0.9863819331303516, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.014927617437491714, - -0.03017831860343839, - -0.018032500968406612 - ], - "translation_xyz_cm": [ - -1.4927617437491714, - -3.017831860343839, - -1.803250096840661 - ], - "translation_norm_m": 0.03819339952486984, - "rotation_rpy_deg_xyz": [ - 0.2247772365985825, - -0.3478803979242266, - -0.47665893977781887 - ], - "rotation_angle_deg": 0.6309497979360814, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.004693539494370014, - 0.005439998853219441, - -0.0018263260517435952 - ], - "translation_xyz_cm": [ - 0.46935394943700137, - 0.5439998853219441, - -0.18263260517435953 - ], - "translation_norm_m": 0.007413391083405577, - "rotation_rpy_deg_xyz": [ - 0.6695380257825311, - -0.5880585377594396, - -0.4774859420944693 - ], - "rotation_angle_deg": 1.0093547927695554, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.01753616317175888, - 0.007302428920282544, - -0.21610104848190811 - ], - "translation_xyz_cm": [ - -1.7536163171758878, - 0.7302428920282544, - -21.61010484819081 - ], - "translation_norm_m": 0.2169343348617326, - "rotation_rpy_deg_xyz": [ - -0.2504156739038121, - 1.178764235078716, - -0.6304381518558443 - ], - "rotation_angle_deg": 1.358815877584971, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.026326508707248078, - 0.020842320427324257, - -0.2430597546521689 - ], - "translation_xyz_cm": [ - -2.6326508707248077, - 2.0842320427324257, - -24.30597546521689 - ], - "translation_norm_m": 0.24536815545844698, - "rotation_rpy_deg_xyz": [ - 0.25064460460749427, - 1.1584204034731096, - -0.39764217669418533 - ], - "rotation_angle_deg": 1.2509544998875717, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.01134974846153719, - 0.029285766195262797, - -0.03725841590683888 - ], - "translation_xyz_cm": [ - 1.134974846153719, - 2.9285766195262797, - -3.725841590683888 - ], - "translation_norm_m": 0.04873050838715668, - "rotation_rpy_deg_xyz": [ - 0.42194842611317446, - -0.1273051984624236, - -0.010545138699485054 - ], - "rotation_angle_deg": 0.44084955220464056, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.01248661405388285, - 0.042446880581510804, - -0.1400497332814413 - ], - "translation_xyz_cm": [ - 1.248661405388285, - 4.24468805815108, - -14.00497332814413 - ], - "translation_norm_m": 0.14687266932222112, - "rotation_rpy_deg_xyz": [ - -0.37099635987791146, - -0.2864311955306975, - 0.16650925508387154 - ], - "rotation_angle_deg": 0.4970887238460194, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.005592908666005647, - 0.017317540639816165, - -0.0888211332567146 - ], - "translation_xyz_cm": [ - 0.5592908666005647, - 1.7317540639816165, - -8.88211332567146 - ], - "translation_norm_m": 0.09066626469732289, - "rotation_rpy_deg_xyz": [ - -0.6629769479445948, - -0.15627031250753695, - 0.16386034017826545 - ], - "rotation_angle_deg": 0.7003657403291428, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.010286148282731222, - -0.02755804222651692, - -0.17532569429810613 - ], - "translation_xyz_cm": [ - -1.0286148282731222, - -2.755804222651692, - -17.532569429810614 - ], - "translation_norm_m": 0.17777612218452113, - "rotation_rpy_deg_xyz": [ - -0.6500524725307848, - 2.2629789791507746, - -0.36851400202685525 - ], - "rotation_angle_deg": 2.3811570917186398, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.0037510384248420903, - 0.019390145369836742, - -0.023447524547628835 - ], - "translation_xyz_cm": [ - 0.375103842484209, - 1.9390145369836742, - -2.3447524547628835 - ], - "translation_norm_m": 0.03065671923314202, - "rotation_rpy_deg_xyz": [ - 1.111847283550198, - 0.0775461346978001, - 0.2212879000626096 - ], - "rotation_angle_deg": 1.1361564107976811, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.0071795416588149585, - 0.03380184722589563, - 0.04919393590097747 - ], - "translation_xyz_cm": [ - 0.7179541658814959, - 3.380184722589563, - 4.919393590097747 - ], - "translation_norm_m": 0.06011783448979951, - "rotation_rpy_deg_xyz": [ - 1.3678957735359896, - 1.5766691325368052, - 0.15977413870956808 - ], - "rotation_angle_deg": 2.091988785997391, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.010630707914655257, - -0.0006992464725010805, - -0.03701172219417436 - ], - "translation_xyz_cm": [ - -1.0630707914655257, - -0.06992464725010805, - -3.701172219417436 - ], - "translation_norm_m": 0.03851452292544668, - "rotation_rpy_deg_xyz": [ - 0.30733659691444726, - 2.650057930638299, - 0.7036582784801544 - ], - "rotation_angle_deg": 2.7572248708339337, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.015381739343084622, - -0.003422115699679429, - 0.3801697342742891 - ], - "translation_xyz_cm": [ - 1.5381739343084622, - -0.3422115699679429, - 38.01697342742891 - ], - "translation_norm_m": 0.3804961703345569, - "rotation_rpy_deg_xyz": [ - -0.9871917462216894, - 0.9838102821009684, - -0.06095758039247643 - ], - "rotation_angle_deg": 1.394664344616238, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010904371217455466, - 0.03573131678403896, - 0.04148851908994938 - ], - "translation_xyz_cm": [ - 1.0904371217455466, - 3.573131678403896, - 4.1488519089949385 - ], - "translation_norm_m": 0.055829468267631834, - "rotation_rpy_deg_xyz": [ - 1.5322773534252003, - -0.3878703142110694, - 0.05874752564496524 - ], - "rotation_angle_deg": 1.5818877136296212, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.005183920891036031, - 0.011532920398821256, - -0.002378141264801204 - ], - "translation_xyz_cm": [ - -0.5183920891036031, - 1.1532920398821256, - -0.23781412648012037 - ], - "translation_norm_m": 0.012866112256832579, - "rotation_rpy_deg_xyz": [ - 0.5027020666131782, - 2.2095773492673803, - 0.49888191389064046 - ], - "rotation_angle_deg": 2.318208210244452, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03368976955866887, - 0.017591843143529573, - 0.13961304122795953 - ], - "translation_xyz_cm": [ - 3.368976955866887, - 1.7591843143529573, - 13.961304122795953 - ], - "translation_norm_m": 0.14469372757318366, - "rotation_rpy_deg_xyz": [ - 0.34771985549576206, - -0.5085551126757093, - -0.2843402219079582 - ], - "rotation_angle_deg": 0.6778699113706804, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.010818393253830601, - 0.004307504625370218, - 0.3777145701593676 - ], - "translation_xyz_cm": [ - 1.08183932538306, - 0.43075046253702176, - 37.77145701593676 - ], - "translation_norm_m": 0.3778940178666076, - "rotation_rpy_deg_xyz": [ - -0.22812530548151924, - 0.8857063132706556, - -0.23469099094623874 - ], - "rotation_angle_deg": 0.9438044565444966, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.015604019294487292, - 0.006872448567230183, - 0.06014361583620148 - ], - "translation_xyz_cm": [ - -1.5604019294487292, - 0.6872448567230183, - 6.014361583620148 - ], - "translation_norm_m": 0.06251376243120023, - "rotation_rpy_deg_xyz": [ - 1.2392207850459298, - 2.68024885579569, - 0.604488646041318 - ], - "rotation_angle_deg": 3.0082230046105485, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0346944596985157, - -0.002876068742758031, - 0.179742648608979 - ], - "translation_xyz_cm": [ - 3.46944596985157, - -0.2876068742758031, - 17.9742648608979 - ], - "translation_norm_m": 0.18308303316843946, - "rotation_rpy_deg_xyz": [ - 0.6717816590293985, - -0.03197288153562339, - -0.211847148966429 - ], - "rotation_angle_deg": 0.7050617942632982, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.039962235257491985, - 0.003452497091473994, - 0.3093289815289546 - ], - "translation_xyz_cm": [ - 3.9962235257491985, - 0.3452497091473994, - 30.93289815289546 - ], - "translation_norm_m": 0.3119187695485511, - "rotation_rpy_deg_xyz": [ - 0.4851011464654319, - 0.33161098226950275, - -0.2231725184610218 - ], - "rotation_angle_deg": 0.6290631362544612, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.026640561913145788, - 0.01724168759533451, - 0.06399796790215366 - ], - "translation_xyz_cm": [ - 2.664056191314579, - 1.724168759533451, - 6.399796790215366 - ], - "translation_norm_m": 0.07143343212941931, - "rotation_rpy_deg_xyz": [ - 1.051955925092525, - -2.383015777493607, - -0.7892816908519429 - ], - "rotation_angle_deg": 2.7154265341862316, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.012530015166301922, - 0.022052531642153372, - 0.1914741170908153 - ], - "translation_xyz_cm": [ - -1.2530015166301922, - 2.2052531642153372, - 19.14741170908153 - ], - "translation_norm_m": 0.19314671353042273, - "rotation_rpy_deg_xyz": [ - 0.9508192031484001, - -0.6999720943338635, - -0.7280833131849882 - ], - "rotation_angle_deg": 1.3840650249994377, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0037595913470778175, - -0.022295570993088987, - 0.15853365949940676 - ], - "translation_xyz_cm": [ - -0.37595913470778175, - -2.2295570993088987, - 15.853365949940676 - ], - "translation_norm_m": 0.1601379037182601, - "rotation_rpy_deg_xyz": [ - -0.9083537774329675, - 0.4895447081688565, - -0.022851983220735554 - ], - "rotation_angle_deg": 1.0320370286712954, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.004016472313726316, - -0.010913937246497252, - -0.06158304289296544 - ], - "translation_xyz_cm": [ - 0.4016472313726316, - -1.0913937246497252, - -6.158304289296544 - ], - "translation_norm_m": 0.06267150267884304, - "rotation_rpy_deg_xyz": [ - -0.2045340329418142, - 0.3751481286638203, - 0.09264509954757771 - ], - "rotation_angle_deg": 0.43735258626096046, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.0002899841212040677, - 0.025957854040399297, - 0.04851095638148642 - ], - "translation_xyz_cm": [ - 0.02899841212040677, - 2.5957854040399297, - 4.851095638148642 - ], - "translation_norm_m": 0.05502006148869431, - "rotation_rpy_deg_xyz": [ - -0.6405298875119025, - -0.011830167714524891, - -0.7135326703905552 - ], - "rotation_angle_deg": 0.9589767582669928, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.01275626926945117, - -0.04692603280086338, - 0.003046012788027917 - ], - "translation_xyz_cm": [ - 1.275626926945117, - -4.692603280086338, - 0.3046012788027917 - ], - "translation_norm_m": 0.04872425632072058, - "rotation_rpy_deg_xyz": [ - 0.39726642316160027, - 0.22961077122800663, - -0.6228416096099091 - ], - "rotation_angle_deg": 0.7742497571412688, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.011928941235070045, - -0.01550326341938213, - 0.004933378485556146 - ], - "translation_xyz_cm": [ - -1.1928941235070045, - -1.550326341938213, - 0.4933378485556146 - ], - "translation_norm_m": 0.02017396933977681, - "rotation_rpy_deg_xyz": [ - 0.38164688651574136, - 0.09902421488630422, - -0.7006205241889311 - ], - "rotation_angle_deg": 0.8042321902211488, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.010242408482136423, - 0.01860561251120063, - -0.049642414285138436 - ], - "translation_xyz_cm": [ - 1.0242408482136423, - 1.860561251120063, - -4.964241428513843 - ], - "translation_norm_m": 0.05399486127854393, - "rotation_rpy_deg_xyz": [ - 0.7010761759537196, - 0.1305166903236783, - 0.1464299505012486 - ], - "rotation_angle_deg": 0.7278391315267184, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.014974367519953458, - 0.005502461911174983, - 0.006735258374280698 - ], - "translation_xyz_cm": [ - 1.4974367519953458, - 0.5502461911174983, - 0.6735258374280697 - ], - "translation_norm_m": 0.017316826356895965, - "rotation_rpy_deg_xyz": [ - 0.9633621990755983, - 1.1400409785931516, - 0.027286637852642574 - ], - "rotation_angle_deg": 1.4926322438475605, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.0033048388937508832, - -0.019039762715141684, - 0.0008503905127081324 - ], - "translation_xyz_cm": [ - 0.3304838893750883, - -1.9039762715141684, - 0.08503905127081324 - ], - "translation_norm_m": 0.019343156112347642, - "rotation_rpy_deg_xyz": [ - -1.2243757719814035, - -1.130827441446531, - 0.153213519681317 - ], - "rotation_angle_deg": 1.6725992881699518, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.011449933901041875, - -0.002969731628631747, - 0.02653152034108651 - ], - "translation_xyz_cm": [ - 1.1449933901041875, - -0.2969731628631747, - 2.653152034108651 - ], - "translation_norm_m": 0.029048956330543288, - "rotation_rpy_deg_xyz": [ - -0.013884223823108142, - -0.6522797335513907, - -0.12387952633174258 - ], - "rotation_angle_deg": 0.6640987671297919, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.00611785061641168, - -0.031709153278068725, - 0.022010277797675087 - ], - "translation_xyz_cm": [ - 0.611785061641168, - -3.1709153278068722, - 2.2010277797675086 - ], - "translation_norm_m": 0.039081336037904514, - "rotation_rpy_deg_xyz": [ - 1.5997868765845134, - 0.27550770330712865, - -0.17843295219202468 - ], - "rotation_angle_deg": 1.63353188395325, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0038748606054634926, - 0.01797131286086051, - -0.08007277239269803 - ], - "translation_xyz_cm": [ - 0.38748606054634926, - 1.797131286086051, - -8.007277239269802 - ], - "translation_norm_m": 0.08215614103222915, - "rotation_rpy_deg_xyz": [ - 0.3069633304810894, - 1.857012992569888, - 0.1006386056189782 - ], - "rotation_angle_deg": 1.8846329770553605, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.009832030871155473, - 0.021846067184009943, - 0.03962605552814211 - ], - "translation_xyz_cm": [ - -0.9832030871155473, - 2.1846067184009943, - 3.962605552814211 - ], - "translation_norm_m": 0.04630489994783524, - "rotation_rpy_deg_xyz": [ - 0.6122924768191591, - 0.9087569361693747, - -0.27413762569014405 - ], - "rotation_angle_deg": 1.130727556732951, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0005375056775167586, - -0.03991639451779694, - -0.05686927147758602 - ], - "translation_xyz_cm": [ - 0.05375056775167586, - -3.991639451779694, - -5.686927147758602 - ], - "translation_norm_m": 0.06948180698603881, - "rotation_rpy_deg_xyz": [ - 0.5180468249073067, - 0.5161813771729791, - -0.08577292881837875 - ], - "rotation_angle_deg": 0.7365942706302443, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.0056330047186952115, - 0.030319116269972746, - -0.04753434981145371 - ], - "translation_xyz_cm": [ - 0.5633004718695211, - 3.0319116269972746, - -4.7534349811453716 - ], - "translation_norm_m": 0.05666122100299832, - "rotation_rpy_deg_xyz": [ - 0.22374058748236705, - 1.6463978455590513, - 0.22739232696649186 - ], - "rotation_angle_deg": 1.6765810352419184, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.01633921711342312, - 0.013276062753547535, - -0.07715370853175041 - ], - "translation_xyz_cm": [ - -1.6339217113423121, - 1.3276062753547535, - -7.715370853175041 - ], - "translation_norm_m": 0.07997448717133487, - "rotation_rpy_deg_xyz": [ - 0.4252608560757961, - 0.27716597483976213, - 0.3626589899282311 - ], - "rotation_angle_deg": 0.6232511916272969, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.02654276151446755, - 0.011751694185465289, - -0.06672358970331035 - ], - "translation_xyz_cm": [ - -2.654276151446755, - 1.175169418546529, - -6.672358970331035 - ], - "translation_norm_m": 0.07276440014140365, - "rotation_rpy_deg_xyz": [ - 0.28223161413406295, - 0.4071479465954922, - 0.07923061401610895 - ], - "rotation_angle_deg": 0.5015399771933156, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.03035322374426519, - 0.017658235396833755, - -0.0482565972389444 - ], - "translation_xyz_cm": [ - -3.035322374426519, - 1.7658235396833755, - -4.825659723894439 - ], - "translation_norm_m": 0.05968107443805878, - "rotation_rpy_deg_xyz": [ - 0.7599255792304269, - 0.6632845217797334, - 0.32892273372495934 - ], - "rotation_angle_deg": 1.0595850788879737, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.003251281754085955, - -0.013328022134304174, - -0.06512011179029122 - ], - "translation_xyz_cm": [ - -0.3251281754085955, - -1.3328022134304174, - -6.5120111790291215 - ], - "translation_norm_m": 0.06654950012311872, - "rotation_rpy_deg_xyz": [ - 1.2257927539078146, - 1.0553661647739734, - 0.5105717577745517 - ], - "rotation_angle_deg": 1.6927673585882872, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.023002577654391176, - -0.019528440134413794, - -0.027701301584390978 - ], - "translation_xyz_cm": [ - 2.3002577654391176, - -1.9528440134413794, - -2.770130158439098 - ], - "translation_norm_m": 0.04096145337142057, - "rotation_rpy_deg_xyz": [ - -0.07283213751762478, - 0.2516938844181246, - -0.22786073951766542 - ], - "rotation_angle_deg": 0.3471337592025384, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008973718190161017, - -0.001747179555624867, - -0.04289213551072955 - ], - "translation_xyz_cm": [ - -0.8973718190161017, - -0.1747179555624867, - -4.2892135510729545 - ], - "translation_norm_m": 0.04385562156926757, - "rotation_rpy_deg_xyz": [ - 0.8674724541752685, - 0.3465875134399516, - 0.2674467448761876 - ], - "rotation_angle_deg": 0.9709540872905119, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.0023288695008840676, - -0.004776700052821603, - 0.061207487833292176 - ], - "translation_xyz_cm": [ - 0.23288695008840676, - -0.4776700052821603, - 6.120748783329217 - ], - "translation_norm_m": 0.06143774949824728, - "rotation_rpy_deg_xyz": [ - 1.5626229666770368, - -0.17077089953881908, - -0.2667872573195967 - ], - "rotation_angle_deg": 1.594013759109997, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.009645996952269531, - 0.0044610784232008704, - 0.010094882949344672 - ], - "translation_xyz_cm": [ - -0.9645996952269531, - 0.44610784232008704, - 1.0094882949344672 - ], - "translation_norm_m": 0.014657869547178785, - "rotation_rpy_deg_xyz": [ - 1.5169892624355394, - 0.8806268010568844, - 0.4408419200238482 - ], - "rotation_angle_deg": 1.8057581471294366, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0020284530990459793, - -0.009341273924805549, - -0.033990500546942956 - ], - "translation_xyz_cm": [ - -0.20284530990459793, - -0.9341273924805549, - -3.3990500546942957 - ], - "translation_norm_m": 0.035309037765776215, - "rotation_rpy_deg_xyz": [ - -0.03143753855684566, - 1.0405826231305049, - -0.2847342027630142 - ], - "rotation_angle_deg": 1.0792169625697328, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.00789740248166293, - 0.01143495752156376, - 0.1382437816234739 - ], - "translation_xyz_cm": [ - 0.789740248166293, - 1.143495752156376, - 13.82437816234739 - ], - "translation_norm_m": 0.1389405282019472, - "rotation_rpy_deg_xyz": [ - 2.035791766356573, - -0.17848249881024977, - -0.4866611681897777 - ], - "rotation_angle_deg": 2.100006782542157, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.004228398492339025, - -0.0010117422495641293, - 0.08535946224029194 - ], - "translation_xyz_cm": [ - 0.4228398492339025, - -0.10117422495641293, - 8.535946224029194 - ], - "translation_norm_m": 0.08547011624036435, - "rotation_rpy_deg_xyz": [ - 1.5910113728132613, - 0.4179281401393101, - 0.1984575104646864 - ], - "rotation_angle_deg": 1.6562153954422192, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.011932009144353106, - 0.006264477001530988, - 0.02811469501461482 - ], - "translation_xyz_cm": [ - 1.1932009144353106, - 0.6264477001530988, - 2.811469501461482 - ], - "translation_norm_m": 0.031177757938768532, - "rotation_rpy_deg_xyz": [ - 1.2023961002833004, - 1.283595348332721, - -0.488624713443134 - ], - "rotation_angle_deg": 1.8289916607711794, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.006234657966015966, - 0.04323503539418405, - 0.08752055919156619 - ], - "translation_xyz_cm": [ - -0.6234657966015966, - 4.323503539418406, - 8.75205591915662 - ], - "translation_norm_m": 0.09781609032615235, - "rotation_rpy_deg_xyz": [ - -1.29194206720628, - -0.21810481602899442, - 0.6220367066983931 - ], - "rotation_angle_deg": 1.4493224785285155, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.02664297648420977, - 0.02661260604296567, - 0.06286126022705647 - ], - "translation_xyz_cm": [ - 2.664297648420977, - 2.661260604296567, - 6.2861260227056475 - ], - "translation_norm_m": 0.07327767077131996, - "rotation_rpy_deg_xyz": [ - -0.5361130180939228, - 0.21231410570413378, - 0.5051011408912992 - ], - "rotation_angle_deg": 0.7672174182160885, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.003221510312388265, - -0.02982945903191181, - 0.008862189335479748 - ], - "translation_xyz_cm": [ - -0.3221510312388265, - -2.982945903191181, - 0.8862189335479748 - ], - "translation_norm_m": 0.03128439154989625, - "rotation_rpy_deg_xyz": [ - 0.08377163071338611, - -0.3913334955475356, - -0.12050623287875221 - ], - "rotation_angle_deg": 0.41786637485135264, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.020610326093230436, - 0.03035446120168661, - -0.048940436359764014 - ], - "translation_xyz_cm": [ - -2.0610326093230436, - 3.035446120168661, - -4.894043635976401 - ], - "translation_norm_m": 0.061166536338083624, - "rotation_rpy_deg_xyz": [ - -0.860768429904989, - -0.2704350641049813, - -0.05462936543042952 - ], - "rotation_angle_deg": 0.9040256041727318, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.011938847812324127, - 0.038136363338687085, - 0.00016198063492905979 - ], - "translation_xyz_cm": [ - 1.1938847812324127, - 3.8136363338687085, - 0.01619806349290598 - ], - "translation_norm_m": 0.039961788417340445, - "rotation_rpy_deg_xyz": [ - -0.3357460709624189, - 0.12265041382980675, - -0.06664213522141806 - ], - "rotation_angle_deg": 0.36354060040881936, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.0011614184503727643, - -0.006263518243465271, - 0.03232570002910447 - ], - "translation_xyz_cm": [ - 0.11614184503727643, - -0.6263518243465271, - 3.232570002910447 - ], - "translation_norm_m": 0.03294740408552293, - "rotation_rpy_deg_xyz": [ - 0.29077208108515834, - -0.9620567495947214, - 0.23501734217829062 - ], - "rotation_angle_deg": 1.0327045961012833, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.014069815844576006, - 0.005131374279886136, - 0.03542184966833962 - ], - "translation_xyz_cm": [ - -1.4069815844576006, - 0.5131374279886136, - 3.542184966833962 - ], - "translation_norm_m": 0.0384577450434501, - "rotation_rpy_deg_xyz": [ - -0.6776922720905256, - -0.6757792681897243, - 0.17347047781255012 - ], - "rotation_angle_deg": 0.9719279049863296, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007315447003994446, - 0.022125905646595, - -0.03409521243184213 - ], - "translation_xyz_cm": [ - 0.7315447003994446, - 2.2125905646595, - -3.409521243184213 - ], - "translation_norm_m": 0.041298365298431824, - "rotation_rpy_deg_xyz": [ - 0.14636167308172934, - 0.17687118492799134, - 0.11193613362386903 - ], - "rotation_angle_deg": 0.25531205431761556, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.01876909800498927, - 0.019666212240269876, - -0.07191636034569178 - ], - "translation_xyz_cm": [ - 1.876909800498927, - 1.9666212240269876, - -7.191636034569178 - ], - "translation_norm_m": 0.0768830399319097, - "rotation_rpy_deg_xyz": [ - 1.0992123701615308, - 0.23488972132936164, - 0.11964187176242971 - ], - "rotation_angle_deg": 1.1301388836253454, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.00693445966729711, - 0.0032479030628467243, - -0.010763907834571023 - ], - "translation_xyz_cm": [ - -0.693445966729711, - 0.3247903062846724, - -1.0763907834571023 - ], - "translation_norm_m": 0.013209743262234846, - "rotation_rpy_deg_xyz": [ - 0.11831378424008403, - 0.08496039720680477, - -0.050146788414175414 - ], - "rotation_angle_deg": 0.15407762611423917, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.02048387040782229, - 0.028880738948014573, - -0.05248834440897 - ], - "translation_xyz_cm": [ - 2.048387040782229, - 2.8880738948014573, - -5.248834440897 - ], - "translation_norm_m": 0.06331439273863784, - "rotation_rpy_deg_xyz": [ - 0.6404725379067169, - 0.6586703893415127, - -0.13348553313496922 - ], - "rotation_angle_deg": 0.9288961598869137, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.024169938688450188, - 0.024788139363808304, - 0.017812821322558924 - ], - "translation_xyz_cm": [ - 2.4169938688450188, - 2.4788139363808304, - 1.7812821322558923 - ], - "translation_norm_m": 0.03893500215477628, - "rotation_rpy_deg_xyz": [ - 0.9260314206605468, - 0.46186426205404335, - -0.08192143113290043 - ], - "rotation_angle_deg": 1.0383499455991019, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0001264532043816491, - -0.0005380667381902349, - 0.007678893038953773 - ], - "translation_xyz_cm": [ - 0.012645320438164909, - -0.05380667381902349, - 0.7678893038953774 - ], - "translation_norm_m": 0.007698759934647773, - "rotation_rpy_deg_xyz": [ - 0.608490705917821, - 0.020864481691322524, - 0.00783180066483866 - ], - "rotation_angle_deg": 0.6088972514420228, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.1547901164802652, - "improved_pairs": 29, - "worsened_pairs": 51, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.10680505252074268, - "global_consistency_signal": false - } - }, - { - "label": "yaw_-0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - -0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977515508234834, - -0.004597357058808013, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150315, - 1.2026608220810582, - -1.035510052785851 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.11873527555886121, - "median": 0.060980247713292274, - "p90": 0.19321547112291018, - "p95": 0.2380182234038797, - "max": 0.38763929302159433 - }, - "rotation_deg": { - "rms": 1.142526017283429, - "median": 0.9282640065321247, - "p90": 1.7009781890331424, - "p95": 2.048721717062998, - "max": 2.7532592440494765 - }, - "normalized_pair_score": { - "rms": 3.295555956965929, - "median": 2.544577823971074, - "p90": 4.953137130849837, - "p95": 5.662216804123775, - "max": 8.150422769426433 - }, - "normalized_global_rms": 3.295555956965929 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01769953771925209, - 0.019631894561293106, - 0.08726640650684972 - ], - "translation_xyz_cm": [ - -1.769953771925209, - 1.9631894561293106, - 8.726640650684972 - ], - "translation_norm_m": 0.09118174501598278, - "rotation_rpy_deg_xyz": [ - 0.37072976311314015, - 0.09797750843591149, - 0.09432476801658161 - ], - "rotation_angle_deg": 0.39481317928354154, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.752893333210111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570956, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01769953771925209, - 0.019631894561293106, - 0.08726640650684972 - ], - "translation_xyz_cm": [ - -1.769953771925209, - 1.9631894561293106, - 8.726640650684972 - ], - "translation_norm_m": 0.09118174501598278, - "rotation_rpy_deg_xyz": [ - 0.37072976311314015, - 0.09797750843591149, - 0.09432476801658161 - ], - "rotation_angle_deg": 0.39481317928354154, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.020638472683121356, - -0.026655138204936035, - 0.17262110415856696 - ], - "translation_xyz_cm": [ - 2.0638472683121356, - -2.6655138204936035, - 17.262110415856696 - ], - "translation_norm_m": 0.17588203020302845, - "rotation_rpy_deg_xyz": [ - -0.39392739225619416, - -0.32712007079357863, - -0.35604595627188707 - ], - "rotation_angle_deg": 0.6243032572335703, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.031241128842030008, - 0.0010704537879486775, - 0.15263488006721593 - ], - "translation_xyz_cm": [ - 3.124112884203001, - 0.10704537879486775, - 15.263488006721593 - ], - "translation_norm_m": 0.15580295445135128, - "rotation_rpy_deg_xyz": [ - -0.09360092985287001, - -0.27561250809209464, - -0.3919021207581217 - ], - "rotation_angle_deg": 0.48835107122741983, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.00846333756477214, - -0.0029054197251994207, - 0.10444330597913833 - ], - "translation_xyz_cm": [ - -0.846333756477214, - -0.29054197251994207, - 10.444330597913833 - ], - "translation_norm_m": 0.10482592098506348, - "rotation_rpy_deg_xyz": [ - 0.5624351601401003, - 0.08248813613935406, - 0.20158592242858908 - ], - "rotation_angle_deg": 0.6030015485331486, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.018718656565454905, - -0.00542853407425592, - -0.02332900887768464 - ], - "translation_xyz_cm": [ - -1.8718656565454905, - -0.542853407425592, - -2.332900887768464 - ], - "translation_norm_m": 0.030399008882295724, - "rotation_rpy_deg_xyz": [ - 0.5700916761153975, - -0.1503949752368123, - 0.05601991987790416 - ], - "rotation_angle_deg": 0.5923217154285063, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.03128801709628537, - -0.020102383683863467, - 0.07532532862748544 - ], - "translation_xyz_cm": [ - 3.128801709628537, - -2.0102383683863465, - 7.5325328627485435 - ], - "translation_norm_m": 0.0840056603832705, - "rotation_rpy_deg_xyz": [ - 0.36259104517619095, - 0.06185223683678944, - -0.34427063365444055 - ], - "rotation_angle_deg": 0.5039390549857714, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04298272899126043, - 0.004497897983129051, - 0.06583049834966612 - ], - "translation_xyz_cm": [ - 4.298272899126044, - 0.4497897983129051, - 6.583049834966611 - ], - "translation_norm_m": 0.07874897199816751, - "rotation_rpy_deg_xyz": [ - 0.6786232936253765, - 0.36376569906588635, - -0.36097828409027183 - ], - "rotation_angle_deg": 0.851300272167772, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0003923349119003272, - -0.00708807146869872, - 0.0027760903740994616 - ], - "translation_xyz_cm": [ - -0.03923349119003272, - -0.708807146869872, - 0.27760903740994614 - ], - "translation_norm_m": 0.007622424915579316, - "rotation_rpy_deg_xyz": [ - 0.9426303288087607, - 0.24507818632054507, - 0.020386755072845576 - ], - "rotation_angle_deg": 0.9741392658395046, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.004478544038337506, - 0.019371838687688686, - 0.0016163288219472553 - ], - "translation_xyz_cm": [ - 0.4478544038337506, - 1.9371838687688685, - 0.16163288219472552 - ], - "translation_norm_m": 0.01994838363642072, - "rotation_rpy_deg_xyz": [ - 0.3366397867492941, - 0.23438366247184536, - -0.025320892185125902 - ], - "rotation_angle_deg": 0.41102056376425117, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.041217058542900475, - -0.003793030324725999, - -0.03464086482102545 - ], - "translation_xyz_cm": [ - -4.121705854290047, - -0.3793030324725999, - -3.464086482102545 - ], - "translation_norm_m": 0.05397427636867154, - "rotation_rpy_deg_xyz": [ - 0.7112686540591545, - 0.8835902165009863, - 0.5757505925688055 - ], - "rotation_angle_deg": 1.2695618641147883, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.05288378559089954, - -0.027067889155919844, - -0.04348328914329708 - ], - "translation_xyz_cm": [ - -5.288378559089954, - -2.7067889155919844, - -4.3483289143297075 - ], - "translation_norm_m": 0.07362174839339918, - "rotation_rpy_deg_xyz": [ - 0.7934266378138218, - 1.4177856745388515, - 0.49273638754455873 - ], - "rotation_angle_deg": 1.694906703112195, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03506043974914881, - -0.02107576839734268, - -0.042867528127794624 - ], - "translation_xyz_cm": [ - -3.5060439749148813, - -2.1075768397342682, - -4.286752812779462 - ], - "translation_norm_m": 0.0592540919829963, - "rotation_rpy_deg_xyz": [ - 0.5301095135140874, - 0.4797815990997577, - 0.5980872587711363 - ], - "rotation_angle_deg": 0.9307274823147854, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04273777907270416, - -0.042029801564339775, - -0.05150797997638075 - ], - "translation_xyz_cm": [ - -4.273777907270416, - -4.202980156433977, - -5.150797997638075 - ], - "translation_norm_m": 0.07903223380907494, - "rotation_rpy_deg_xyz": [ - 0.7406777446660228, - 0.9837317035119634, - 0.517474372226343 - ], - "rotation_angle_deg": 1.3332317227955535, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.013227012948255353, - -0.01314331234879923, - -0.009707283659563058 - ], - "translation_xyz_cm": [ - -1.3227012948255352, - -1.314331234879923, - -0.9707283659563057 - ], - "translation_norm_m": 0.021022176078575525, - "rotation_rpy_deg_xyz": [ - 0.3878570945185717, - 0.3495858886889525, - -0.08705446415902256 - ], - "rotation_angle_deg": 0.5295539563230259, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.0044132242648766695, - -0.01726737108090487, - -0.19139603428680688 - ], - "translation_xyz_cm": [ - 0.44132242648766695, - -1.726737108090487, - -19.139603428680687 - ], - "translation_norm_m": 0.19222403750097, - "rotation_rpy_deg_xyz": [ - -0.871486388954484, - 0.06298456568900439, - 0.331052638199308 - ], - "rotation_angle_deg": 0.9345407340946449, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.004190055305879903, - 0.005951802371718258, - -0.23642609732476258 - ], - "translation_xyz_cm": [ - -0.4190055305879903, - 0.5951802371718258, - -23.64260973247626 - ], - "translation_norm_m": 0.23653811534540564, - "rotation_rpy_deg_xyz": [ - -0.5535749283448294, - -0.22435758897423883, - 0.4316530615420683 - ], - "rotation_angle_deg": 0.7363206713983863, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.009699575391104776, - -0.0009102036692866244, - -0.0221171785425439 - ], - "translation_xyz_cm": [ - -0.9699575391104776, - -0.09102036692866244, - -2.21171785425439 - ], - "translation_norm_m": 0.024167743381831752, - "rotation_rpy_deg_xyz": [ - 0.1224299601722492, - -0.07544176478257476, - -0.09917566305373945 - ], - "rotation_angle_deg": 0.17464355779766502, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.0003533906593036068, - 0.020828645580045935, - -0.26532374454949187 - ], - "translation_xyz_cm": [ - 0.03533906593036068, - 2.0828645580045935, - -26.53237445494919 - ], - "translation_norm_m": 0.2661402765148884, - "rotation_rpy_deg_xyz": [ - -0.6268743701120475, - -0.0899960514267489, - 0.06819689901760655 - ], - "rotation_angle_deg": 0.6369099654382249, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.0010529203397950937, - 0.00948282762278485, - -0.16141811883700488 - ], - "translation_xyz_cm": [ - -0.10529203397950937, - 0.9482827622784851, - -16.141811883700488 - ], - "translation_norm_m": 0.16169985080340313, - "rotation_rpy_deg_xyz": [ - -0.5298420205475538, - 0.7331699857076515, - 0.27623490163260833 - ], - "rotation_angle_deg": 0.9468072491989274, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.00755933141337678, - 0.0260408790353992, - 0.00949827899769852 - ], - "translation_xyz_cm": [ - 0.755933141337678, - 2.60408790353992, - 0.9498278997698519 - ], - "translation_norm_m": 0.0287313100340322, - "rotation_rpy_deg_xyz": [ - 0.26424871811137957, - -0.8312384021288093, - -0.25157673765717936 - ], - "rotation_angle_deg": 0.9072533325217037, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.016426194113871695, - -0.024790011547678212, - -0.023960808588821908 - ], - "translation_xyz_cm": [ - -1.6426194113871695, - -2.4790011547678215, - -2.3960808588821907 - ], - "translation_norm_m": 0.03819011487061506, - "rotation_rpy_deg_xyz": [ - 0.06763169804302015, - -0.33907715109670894, - -0.48023678683644644 - ], - "rotation_angle_deg": 0.5915926019510654, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.002520786436515543, - 0.009674743231941174, - -0.004855987078108127 - ], - "translation_xyz_cm": [ - 0.2520786436515543, - 0.9674743231941174, - -0.48559870781081266 - ], - "translation_norm_m": 0.011114658400745629, - "rotation_rpy_deg_xyz": [ - 0.44261202761711177, - -0.601736452980534, - -0.4831589993919038 - ], - "rotation_angle_deg": 0.8883601428323116, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.016270409776299788, - 0.0038983951547009177, - -0.2014447775725283 - ], - "translation_xyz_cm": [ - -1.6270409776299788, - 0.38983951547009177, - -20.14447775725283 - ], - "translation_norm_m": 0.20213837372037083, - "rotation_rpy_deg_xyz": [ - -0.6549444331810687, - 0.9454238796571128, - -0.6411517255029519 - ], - "rotation_angle_deg": 1.314116259589663, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.022120318156380818, - 0.01774079423053765, - -0.22350457667761892 - ], - "translation_xyz_cm": [ - -2.2120318156380816, - 1.7740794230537649, - -22.35045766776189 - ], - "translation_norm_m": 0.22529611636934938, - "rotation_rpy_deg_xyz": [ - -0.15842786720352064, - 0.8143631630688583, - -0.41200851399517224 - ], - "rotation_angle_deg": 0.925800530749464, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.011853146657497371, - 0.028836328393333277, - -0.035555718978397884 - ], - "translation_xyz_cm": [ - 1.185314665749737, - 2.8836328393333277, - -3.5555718978397883 - ], - "translation_norm_m": 0.04728890010312255, - "rotation_rpy_deg_xyz": [ - 0.34991688769963164, - -0.11335075473918371, - -0.011973693588124595 - ], - "rotation_angle_deg": 0.3680017145989839, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.014122519174252002, - 0.04185044170240437, - -0.135692197200309 - ], - "translation_xyz_cm": [ - 1.4122519174252002, - 4.185044170240437, - -13.569219720030901 - ], - "translation_norm_m": 0.1426999558498916, - "rotation_rpy_deg_xyz": [ - -0.531355229031236, - -0.27832031757742437, - 0.16276072252892915 - ], - "rotation_angle_deg": 0.6211849404404546, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.006657914426207556, - 0.017060020006822052, - -0.08705152568086463 - ], - "translation_xyz_cm": [ - 0.6657914426207556, - 1.7060020006822052, - -8.705152568086463 - ], - "translation_norm_m": 0.0889569571787733, - "rotation_rpy_deg_xyz": [ - -0.7502793178689086, - -0.14157482299150662, - 0.16180554413495798 - ], - "rotation_angle_deg": 0.7802838421023643, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.00589107667083022, - -0.03133867945429358, - -0.16379647683986961 - ], - "translation_xyz_cm": [ - -0.589107667083022, - -3.1338679454293583, - -16.37964768398696 - ], - "translation_norm_m": 0.16687151775972586, - "rotation_rpy_deg_xyz": [ - -0.850421197810317, - 2.259974110880241, - -0.37324635202135764 - ], - "rotation_angle_deg": 2.4407739487514917, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.005465761555848159, - 0.0192974715271389, - -0.02142754606360176 - ], - "translation_xyz_cm": [ - 0.5465761555848159, - 1.9297471527138899, - -2.1427546063601763 - ], - "translation_norm_m": 0.02934973061262913, - "rotation_rpy_deg_xyz": [ - 1.001901640142309, - 0.09209745150596131, - 0.21914502953724915 - ], - "rotation_angle_deg": 1.0295431056764424, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.010495856458244468, - 0.030076763268550133, - 0.06029068105054795 - ], - "translation_xyz_cm": [ - 1.0495856458244468, - 3.0076763268550133, - 6.029068105054796 - ], - "translation_norm_m": 0.06818900874073021, - "rotation_rpy_deg_xyz": [ - 1.1458312633579384, - 1.5653220513390178, - 0.15413107840224285 - ], - "rotation_angle_deg": 1.9447390375576614, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.011422659827979853, - 0.006934564889977235, - -0.023010023443582224 - ], - "translation_xyz_cm": [ - -1.1422659827979853, - 0.6934564889977235, - -2.3010023443582224 - ], - "translation_norm_m": 0.02660876785259425, - "rotation_rpy_deg_xyz": [ - -0.10107722918942129, - 2.2989243210632977, - 0.6888586653782028 - ], - "rotation_angle_deg": 2.402607849811502, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.0128936284816904, - -0.00693951052260644, - 0.38736264537583415 - ], - "translation_xyz_cm": [ - 1.28936284816904, - -0.693951052260644, - 38.736264537583416 - ], - "translation_norm_m": 0.38763929302159433, - "rotation_rpy_deg_xyz": [ - -1.1949945190290059, - 0.3867227936693216, - -0.06218009608488728 - ], - "rotation_angle_deg": 1.2573486710805664, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.01227018797600743, - 0.03148073268446361, - 0.04962426841205907 - ], - "translation_xyz_cm": [ - 1.227018797600743, - 3.148073268446361, - 4.9624268412059065 - ], - "translation_norm_m": 0.06003467380397178, - "rotation_rpy_deg_xyz": [ - 1.41823154782434, - -0.37351388423595594, - 0.05660545147207501 - ], - "rotation_angle_deg": 1.4678602012812054, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.0058421900765774915, - 0.01746543025196079, - 0.006306571989140635 - ], - "translation_xyz_cm": [ - -0.5842190076577491, - 1.746543025196079, - 0.6306571989140636 - ], - "translation_norm_m": 0.019466517126368058, - "rotation_rpy_deg_xyz": [ - 0.09640101139075866, - 1.9693817150237038, - 0.484936878565618 - ], - "rotation_angle_deg": 2.030096131128867, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.03136900147952737, - 0.018214181558521947, - 0.1516095422174378 - ], - "translation_xyz_cm": [ - 3.136900147952737, - 1.8214181558521947, - 15.160954221743781 - ], - "translation_norm_m": 0.15588849846942027, - "rotation_rpy_deg_xyz": [ - -0.0374891022101066, - -0.9361241695856968, - -0.30010823429897965 - ], - "rotation_angle_deg": 0.9838600654422205, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.010216179171757517, - 0.0005221513470807793, - 0.387392357123592 - ], - "translation_xyz_cm": [ - 1.0216179171757518, - 0.052215134708077926, - 38.739235712359196 - ], - "translation_norm_m": 0.3875273942789998, - "rotation_rpy_deg_xyz": [ - -0.5311916053182183, - 0.34563564492307863, - -0.24522044123122902 - ], - "rotation_angle_deg": 0.6789509051411456, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.02054234342433836, - 0.012369960312830497, - 0.058297365477805965 - ], - "translation_xyz_cm": [ - -2.054234342433836, - 1.2369960312830497, - 5.8297365477805965 - ], - "translation_norm_m": 0.06303639118126403, - "rotation_rpy_deg_xyz": [ - 0.8751601758841604, - 2.5470806194099076, - 0.5917116810425564 - ], - "rotation_angle_deg": 2.7532592440494765, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.02998406189519509, - -0.00493566209541485, - 0.18514303266598203 - ], - "translation_xyz_cm": [ - 2.998406189519509, - -0.493566209541485, - 18.514303266598205 - ], - "translation_norm_m": 0.18762022085268926, - "rotation_rpy_deg_xyz": [ - 0.260427332163708, - -0.3474619528536646, - -0.22819641071055538 - ], - "rotation_angle_deg": 0.4901682902383367, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.038261119964351886, - -0.00390279800948079, - 0.3161182138560599 - ], - "translation_xyz_cm": [ - 3.8261119964351886, - -0.390279800948079, - 31.611821385605992 - ], - "translation_norm_m": 0.31844916433361065, - "rotation_rpy_deg_xyz": [ - 0.11050162149875117, - -0.11834298782643238, - -0.24015309961140904 - ], - "rotation_angle_deg": 0.2895415816677459, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.02940261268927613, - 0.012386781806227765, - 0.07598715572895154 - ], - "translation_xyz_cm": [ - 2.940261268927613, - 1.2386781806227765, - 7.598715572895154 - ], - "translation_norm_m": 0.08241355369262152, - "rotation_rpy_deg_xyz": [ - 0.8637339453585896, - -2.382016409532787, - -0.7937090222621433 - ], - "rotation_angle_deg": 2.6497737970518616, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.005818595501184909, - 0.015267637485874452, - 0.21371466927971364 - ], - "translation_xyz_cm": [ - -0.5818595501184909, - 1.5267637485874452, - 21.371466927971365 - ], - "translation_norm_m": 0.2143383229227659, - "rotation_rpy_deg_xyz": [ - 0.6416163681111158, - -0.768162938994497, - -0.7372200176480626 - ], - "rotation_angle_deg": 1.2405150413124717, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.001322480493249012, - -0.026188010056330313, - 0.1676901606609604 - ], - "translation_xyz_cm": [ - -0.1322480493249012, - -2.6188010056330313, - 16.76901606609604 - ], - "translation_norm_m": 0.16972787280781018, - "rotation_rpy_deg_xyz": [ - -1.0472249088726615, - 0.5013606987807923, - -0.026181905990095577 - ], - "rotation_angle_deg": 1.1612411936043423, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.010051096080562483, - -0.011116808338462292, - -0.05193720209876178 - ], - "translation_xyz_cm": [ - 1.0051096080562483, - -1.1116808338462292, - -5.193720209876178 - ], - "translation_norm_m": 0.054056275508977014, - "rotation_rpy_deg_xyz": [ - -0.44566905285740055, - 0.35450780958571715, - 0.08680034472551018 - ], - "rotation_angle_deg": 0.5762548463344792, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - 0.003755847704565607, - 0.01685303204163513, - 0.0675706751685925 - ], - "translation_xyz_cm": [ - 0.3755847704565607, - 1.685303204163513, - 6.75706751685925 - ], - "translation_norm_m": 0.06974186134392825, - "rotation_rpy_deg_xyz": [ - -0.8256077059672355, - -0.009959579152789654, - -0.7179050531309027 - ], - "rotation_angle_deg": 1.0941704852434493, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.014055088020736406, - -0.03651377202832817, - -0.0038650171742015665 - ], - "translation_xyz_cm": [ - 1.4055088020736406, - -3.6513772028328173, - -0.38650171742015665 - ], - "translation_norm_m": 0.03931589252152674, - "rotation_rpy_deg_xyz": [ - 0.12815174377162677, - 0.1926555214552762, - -0.6298449851624462 - ], - "rotation_angle_deg": 0.6712038249104364, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.022900628037994863, - -0.031025046248124966, - 0.011930501961157872 - ], - "translation_xyz_cm": [ - -2.2900628037994863, - -3.1025046248124966, - 1.193050196115787 - ], - "translation_norm_m": 0.04036494935309694, - "rotation_rpy_deg_xyz": [ - 0.5666930866394816, - -0.3480109427812121, - -0.70570189790907 - ], - "rotation_angle_deg": 0.9684173657810855, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012466406742760672, - 0.030922163261671853, - -0.060420767931306886 - ], - "translation_xyz_cm": [ - 1.2466406742760672, - 3.0922163261671853, - -6.042076793130689 - ], - "translation_norm_m": 0.06900913472335586, - "rotation_rpy_deg_xyz": [ - 0.46659986442537754, - 0.1133091399799631, - 0.1404923573197429 - ], - "rotation_angle_deg": 0.5001626440435887, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.005600327548741013, - -0.0032738509481711198, - 0.020261478117104853 - ], - "translation_xyz_cm": [ - 0.5600327548741013, - -0.327385094817112, - 2.0261478117104854 - ], - "translation_norm_m": 0.021274615488274924, - "rotation_rpy_deg_xyz": [ - 1.1774372986719863, - 0.775502743983497, - 0.020843054001345986 - ], - "rotation_angle_deg": 1.4099092788351704, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.00018332394061282287, - -0.003751792536456411, - -0.021705761025494125 - ], - "translation_xyz_cm": [ - 0.018332394061282287, - -0.3751792536456411, - -2.1705761025494126 - ], - "translation_norm_m": 0.022028382069495516, - "rotation_rpy_deg_xyz": [ - -1.3982262497388969, - -1.1259285808375894, - 0.14905424095908285 - ], - "rotation_angle_deg": 1.800224630297897, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.005486530417441404, - 0.0035149496206295094, - 0.021637613779022583 - ], - "translation_xyz_cm": [ - 0.5486530417441404, - 0.35149496206295094, - 2.1637613779022584 - ], - "translation_norm_m": 0.022597416155552413, - "rotation_rpy_deg_xyz": [ - -0.37632919589740205, - -0.7842516287454125, - -0.13369537618705205 - ], - "rotation_angle_deg": 0.8804742241525626, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.00414297789194773, - -0.02655226817232581, - 0.035602241611491614 - ], - "translation_xyz_cm": [ - -0.414297789194773, - -2.655226817232581, - 3.5602241611491614 - ], - "translation_norm_m": 0.04460612983291982, - "rotation_rpy_deg_xyz": [ - 1.3368495013325015, - -0.2935449483441324, - -0.20656643018409254 - ], - "rotation_angle_deg": 1.3836850003764838, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.01015342246164369, - 0.009270439719982537, - -0.06150482228293001 - ], - "translation_xyz_cm": [ - -1.015342246164369, - 0.9270439719982537, - -6.150482228293002 - ], - "translation_norm_m": 0.06302282288458083, - "rotation_rpy_deg_xyz": [ - 0.49997966135971217, - 1.4267705196344584, - 0.09663303001075252 - ], - "rotation_angle_deg": 1.5145214224117753, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.0023653057428518753, - 0.019261739930142685, - 0.0526587257618879 - ], - "translation_xyz_cm": [ - -0.23653057428518753, - 1.9261739930142685, - 5.265872576188791 - ], - "translation_norm_m": 0.056120857934099135, - "rotation_rpy_deg_xyz": [ - 0.37966517955751306, - 0.8924741481689585, - -0.27998386331491903 - ], - "rotation_angle_deg": 1.010295861070365, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.003179369652844155, - -0.028125550157391932, - -0.05702578438174049 - ], - "translation_xyz_cm": [ - -0.3179369652844155, - -2.812555015739193, - -5.702578438174049 - ], - "translation_norm_m": 0.06366392265167262, - "rotation_rpy_deg_xyz": [ - 0.12032175348438774, - 0.3083633764368611, - -0.09900145494346842 - ], - "rotation_angle_deg": 0.34558737271666473, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - -0.01520871566948978, - 0.026807383561312292, - -0.04526082548388845 - ], - "translation_xyz_cm": [ - -1.520871566948978, - 2.6807383561312292, - -4.526082548388845 - ], - "translation_norm_m": 0.05475840729241224, - "rotation_rpy_deg_xyz": [ - 0.07699796637316908, - 1.0329896574142907, - 0.21442432714579057 - ], - "rotation_angle_deg": 1.0576743516121891, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017373314877036083, - 0.0016545227301795196, - -0.07137355514800975 - ], - "translation_xyz_cm": [ - -1.7373314877036083, - 0.16545227301795196, - -7.137355514800975 - ], - "translation_norm_m": 0.07347621308796005, - "rotation_rpy_deg_xyz": [ - 0.6345384780044455, - 0.059366913438672286, - 0.362786489270391 - ], - "rotation_angle_deg": 0.7331695785477736, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.03528269276874618, - 0.019009904502765185, - -0.07700749640992716 - ], - "translation_xyz_cm": [ - -3.528269276874618, - 1.9009904502765185, - -7.700749640992716 - ], - "translation_norm_m": 0.08681243794262969, - "rotation_rpy_deg_xyz": [ - -0.0526862445905173, - 0.31253911220353925, - 0.06991131668061043 - ], - "rotation_angle_deg": 0.324598524383457, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.04042768299641897, - 0.019331040945162914, - -0.05289724920354472 - ], - "translation_xyz_cm": [ - -4.042768299641897, - 1.9331040945162914, - -5.289724920354472 - ], - "translation_norm_m": 0.06932680340088111, - "rotation_rpy_deg_xyz": [ - 0.3525477119607444, - 0.41529878905663037, - 0.31369891928337973 - ], - "rotation_angle_deg": 0.6279865278118716, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.013380560079721215, - -0.017496185577204226, - -0.056663337422002635 - ], - "translation_xyz_cm": [ - -1.3380560079721215, - -1.7496185577204226, - -5.666333742200264 - ], - "translation_norm_m": 0.060793829502661885, - "rotation_rpy_deg_xyz": [ - 1.211333968577648, - 0.4487437980259796, - 0.48951859609825304 - ], - "rotation_angle_deg": 1.379734614259981, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014594563270969196, - -0.02197796452296452, - -0.01512701600442859 - ], - "translation_xyz_cm": [ - 1.4594563270969196, - -2.197796452296452, - -1.5127016004428588 - ], - "translation_norm_m": 0.030411491493204486, - "rotation_rpy_deg_xyz": [ - 0.052405042324071935, - -0.27601698459724455, - -0.23159909548722207 - ], - "rotation_angle_deg": 0.3640209112644805, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007912186988334569, - -0.0016346527248829457, - -0.0397014730921325 - ], - "translation_xyz_cm": [ - -0.7912186988334569, - -0.16346527248829457, - -3.9701473092132495 - ], - "translation_norm_m": 0.04051520403693728, - "rotation_rpy_deg_xyz": [ - 0.6978611581462263, - 0.3527107698480769, - 0.26360119657226033 - ], - "rotation_angle_deg": 0.8244790019644808, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.01406079983368258, - -0.01165828159797222, - 0.045508990117874494 - ], - "translation_xyz_cm": [ - -1.406079983368258, - -1.165828159797222, - 4.5508990117874495 - ], - "translation_norm_m": 0.049037636600159515, - "rotation_rpy_deg_xyz": [ - 1.1608938182333444, - -0.5499443214310024, - -0.29018603757416217 - ], - "rotation_angle_deg": 1.315702790994509, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.023193522837437808, - 0.011269021888666408, - 0.015048981524843852 - ], - "translation_xyz_cm": [ - -2.3193522837437808, - 1.1269021888666408, - 1.5048981524843852 - ], - "translation_norm_m": 0.02985635947119279, - "rotation_rpy_deg_xyz": [ - 1.1724458487610898, - 0.38454710171940987, - 0.4146672295466878 - ], - "rotation_angle_deg": 1.3004537014787485, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.01851926892947553, - -0.0037425180360193266, - -0.021851583115125237 - ], - "translation_xyz_cm": [ - -1.851926892947553, - -0.37425180360193266, - -2.1851583115125237 - ], - "translation_norm_m": 0.028887046362849108, - "rotation_rpy_deg_xyz": [ - -0.24805247931709, - 0.447043033408938, - -0.2960401906750366 - ], - "rotation_angle_deg": 0.5902909888369071, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.008389528082125342, - 0.0034143952587255555, - 0.12722196764882476 - ], - "translation_xyz_cm": [ - -0.8389528082125342, - 0.34143952587255555, - 12.722196764882476 - ], - "translation_norm_m": 0.12754399761988877, - "rotation_rpy_deg_xyz": [ - 1.637630152008551, - -0.38792075849245466, - -0.5054951709301369 - ], - "rotation_angle_deg": 1.755621562321663, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008456079149312679, - 0.005314125515100132, - 0.0797353018345103 - ], - "translation_xyz_cm": [ - -0.8456079149312679, - 0.5314125515100132, - 7.973530183451031 - ], - "translation_norm_m": 0.0803583447017803, - "rotation_rpy_deg_xyz": [ - 1.18153709530713, - 0.07856176925752208, - 0.17619509068717748 - ], - "rotation_angle_deg": 1.1970629873046434, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0033332017400704572, - 0.011618163562621575, - 0.028231884721748368 - ], - "translation_xyz_cm": [ - -0.3333201740070457, - 1.1618163562621575, - 2.823188472174837 - ], - "translation_norm_m": 0.030710442415405305, - "rotation_rpy_deg_xyz": [ - 0.8518687506863247, - 0.7950709932976321, - -0.5119528344057699 - ], - "rotation_angle_deg": 1.2751255223416518, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.007772590153440895, - 0.057250758067320606, - 0.07302423446079485 - ], - "translation_xyz_cm": [ - -0.7772590153440895, - 5.725075806732061, - 7.3024234460794855 - ], - "translation_norm_m": 0.09311606346684433, - "rotation_rpy_deg_xyz": [ - -1.1567443476507142, - -0.3034026186350333, - 0.6259564042690645 - ], - "rotation_angle_deg": 1.3483621448904277, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.03573712780158811, - 0.041291817218994886, - 0.05077799637558496 - ], - "translation_xyz_cm": [ - 3.573712780158811, - 4.129181721899489, - 5.0777996375584955 - ], - "translation_norm_m": 0.07456917183845374, - "rotation_rpy_deg_xyz": [ - -0.3157056005174438, - -0.09866317517778897, - 0.5086180088624356 - ], - "rotation_angle_deg": 0.6064812255806594, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.002874590614232675, - -0.026543685432133646, - 0.0053939122784826335 - ], - "translation_xyz_cm": [ - -0.2874590614232675, - -2.654368543213365, - 0.5393912278482633 - ], - "translation_norm_m": 0.027238296517724164, - "rotation_rpy_deg_xyz": [ - 0.26841365800645894, - -0.5464657830011603, - -0.11861641353999315 - ], - "rotation_angle_deg": 0.6200292390814343, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.017991417160243772, - 0.018191199610105624, - -0.055558529368226986 - ], - "translation_xyz_cm": [ - -1.7991417160243772, - 1.8191199610105624, - -5.555852936822698 - ], - "translation_norm_m": 0.06116666592392266, - "rotation_rpy_deg_xyz": [ - -0.9689272174930073, - -0.8878421047793786, - -0.05527192058144169 - ], - "rotation_angle_deg": 1.3156555357860475, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.007307954338843459, - 0.020667111977059394, - -0.014102354232192707 - ], - "translation_xyz_cm": [ - 0.7307954338843459, - 2.0667111977059394, - -1.4102354232192706 - ], - "translation_norm_m": 0.026065534887686006, - "rotation_rpy_deg_xyz": [ - -0.5783228386525225, - -0.4586973640577997, - -0.07521770584523371 - ], - "rotation_angle_deg": 0.7422025791537008, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - 0.0013474192787055195, - -0.0016850170153785426, - 0.02746172961012555 - ], - "translation_xyz_cm": [ - 0.13474192787055195, - -0.16850170153785426, - 2.7461729610125554 - ], - "translation_norm_m": 0.027546350288820277, - "rotation_rpy_deg_xyz": [ - 0.45791063284073463, - -1.087694877361352, - 0.23652966854169083 - ], - "rotation_angle_deg": 1.2044735089992442, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.013443055238460566, - 0.007551874431890593, - 0.038059246362791295 - ], - "translation_xyz_cm": [ - -1.3443055238460566, - 0.7551874431890593, - 3.8059246362791295 - ], - "translation_norm_m": 0.041064008271027165, - "rotation_rpy_deg_xyz": [ - -0.469849874333139, - -1.0657670650363915, - 0.17726930897973578 - ], - "rotation_angle_deg": 1.1774914068251934, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.007125437636219978, - 0.012002181198884632, - -0.03909274941040883 - ], - "translation_xyz_cm": [ - 0.7125437636219978, - 1.2002181198884632, - -3.909274941040883 - ], - "translation_norm_m": 0.04150984547674852, - "rotation_rpy_deg_xyz": [ - 0.2645819013402327, - -0.3574711260848621, - 0.10593585823264016 - ], - "rotation_angle_deg": 0.45736876108030977, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.012392998821146861, - 0.0052754662336517155, - -0.08154232991468456 - ], - "translation_xyz_cm": [ - 1.2392998821146861, - 0.5275466233651716, - -8.154232991468456 - ], - "translation_norm_m": 0.08264725362453738, - "rotation_rpy_deg_xyz": [ - 1.096720836647421, - -0.36843441284759376, - 0.10025023977270754 - ], - "rotation_angle_deg": 1.1615907773284935, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.009773942972182592, - 0.0027356651527965514, - -0.007165858635726944 - ], - "translation_xyz_cm": [ - -0.9773942972182592, - 0.27356651527965514, - -0.7165858635726944 - ], - "translation_norm_m": 0.012424305012310559, - "rotation_rpy_deg_xyz": [ - 0.31510152128942587, - -0.0962419720064821, - -0.04851449364506905 - ], - "rotation_angle_deg": 0.3329856363239872, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.01548541042435203, - 0.01789273758744203, - -0.04604925596896019 - ], - "translation_xyz_cm": [ - 1.548541042435203, - 1.7892737587442031, - -4.6049255968960185 - ], - "translation_norm_m": 0.051773371241194126, - "rotation_rpy_deg_xyz": [ - 0.8572407591137061, - 0.30869404995000804, - -0.1374420035187229 - ], - "rotation_angle_deg": 0.9217790684541854, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.02155782262355599, - 0.012480649160452884, - 0.03153342134531671 - ], - "translation_xyz_cm": [ - 2.155782262355599, - 1.2480649160452884, - 3.153342134531671 - ], - "translation_norm_m": 0.04018535779953056, - "rotation_rpy_deg_xyz": [ - 1.0682532467877768, - 0.36874200627839215, - -0.08137983277094685 - ], - "rotation_angle_deg": 1.1332756409509883, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - -0.0018689138715510811, - -0.006353415911950933, - 0.01492175032426493 - ], - "translation_xyz_cm": [ - -0.1868913871551081, - -0.6353415911950933, - 1.492175032426493 - ], - "translation_norm_m": 0.016325359584070664, - "rotation_rpy_deg_xyz": [ - 0.7286328738875988, - -0.049454412865246815, - 0.008945252879816231 - ], - "rotation_angle_deg": 0.7303678615326775, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": -0.0006796602588061695, - "improved_pairs": 45, - "worsened_pairs": 35, - "unchanged_pairs": 0, - "median_per_pair_score_change": -0.0021608242414224432, - "global_consistency_signal": true - } - }, - { - "label": "yaw_+0.200_diagnostic", - "body_left_rpy_correction_deg_xyz": [ - 0.0, - 0.0, - 0.2 - ], - "candidate_extrinsic": { - "translation_m": [ - 1.2977520208799274, - 0.004462696353922578, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150318, - 1.2026608220810453, - -0.635510052785851 - ] - }, - "all_pairs": { - "count": 80, - "translation_m": { - "rms": 0.1194719055604376, - "median": 0.06295795246392297, - "p90": 0.19301830101765383, - "p95": 0.238194534594602, - "max": 0.3876987366268414 - }, - "rotation_deg": { - "rms": 1.142526017283429, - "median": 0.9282640065321225, - "p90": 1.7009781890331412, - "p95": 2.048721717062998, - "max": 2.7532592440494765 - }, - "normalized_pair_score": { - "rms": 3.306187727273662, - "median": 2.5737456417212154, - "p90": 4.962916520863176, - "p95": 5.651916080470001, - "max": 8.140780288752206 - }, - "normalized_global_rms": 3.306187727273662 - }, - "selected_pair": { - "translation_xyz_m": [ - -0.01926909221153389, - 0.02277541774810865, - 0.0872997100035128 - ], - "translation_xyz_cm": [ - -1.926909221153389, - 2.277541774810865, - 8.72997100035128 - ], - "translation_norm_m": 0.09225647367504836, - "rotation_rpy_deg_xyz": [ - 0.3707297631131401, - 0.09797750843591149, - 0.09432476801658396 - ], - "rotation_angle_deg": 0.39481317928354204, - "pair_index": 0, - "i": 0, - "j": 1 - }, - "ground": { - "normal_tilt_deg": { - "rms": 1.6662748432297787, - "median": 0.7528933332101111, - "p90": 2.3672634656614586, - "p95": 3.9662750686570947, - "max": 5.529555209905641 - }, - "height_residual_m": { - "rms": 0.0347139651712173, - "median": -0.005924101606088833, - "p90": 0.053409267341990724, - "p95": 0.08720196104337455, - "max": 0.12336745254185402 - } - }, - "per_pair": [ - { - "translation_xyz_m": [ - -0.01926909221153389, - 0.02277541774810865, - 0.0872997100035128 - ], - "translation_xyz_cm": [ - -1.926909221153389, - 2.277541774810865, - 8.72997100035128 - ], - "translation_norm_m": 0.09225647367504836, - "rotation_rpy_deg_xyz": [ - 0.3707297631131401, - 0.09797750843591149, - 0.09432476801658396 - ], - "rotation_angle_deg": 0.39481317928354204, - "pair_index": 0, - "i": 0, - "j": 1 - }, - { - "translation_xyz_m": [ - 0.017525542899309632, - -0.01917832471619363, - 0.17258765671745335 - ], - "translation_xyz_cm": [ - 1.7525542899309632, - -1.9178324716193629, - 17.258765671745337 - ], - "translation_norm_m": 0.1745320945959706, - "rotation_rpy_deg_xyz": [ - -0.3939273922561944, - -0.32712007079357863, - -0.35604595627189023 - ], - "rotation_angle_deg": 0.6243032572335723, - "pair_index": 1, - "i": 0, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.027148982354854745, - 0.00783813024896518, - 0.15260943584223916 - ], - "translation_xyz_cm": [ - 2.7148982354854745, - 0.783813024896518, - 15.260943584223915 - ], - "translation_norm_m": 0.15520355484585546, - "rotation_rpy_deg_xyz": [ - -0.09360092985287016, - -0.27561250809209464, - -0.39190212075812014 - ], - "rotation_angle_deg": 0.48835107122741855, - "pair_index": 2, - "i": 0, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.012281662719327395, - 0.0030467291212636916, - 0.10450936375522468 - ], - "translation_xyz_cm": [ - -1.2281662719327395, - 0.30467291212636916, - 10.450936375522469 - ], - "translation_norm_m": 0.10527264084277331, - "rotation_rpy_deg_xyz": [ - 0.5624351601401003, - 0.08248813613935406, - 0.20158592242858897 - ], - "rotation_angle_deg": 0.6030015485331486, - "pair_index": 3, - "i": 0, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.022970454944483687, - -0.0007889096023352415, - -0.023319484383642196 - ], - "translation_xyz_cm": [ - -2.2970454944483687, - -0.07889096023352415, - -2.3319484383642197 - ], - "translation_norm_m": 0.032742365990199064, - "rotation_rpy_deg_xyz": [ - 0.5700916761153975, - -0.1503949752368123, - 0.05601991987790396 - ], - "rotation_angle_deg": 0.5923217154285063, - "pair_index": 4, - "i": 0, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.0303941714614131, - -0.015349682758463712, - 0.0754020636488316 - ], - "translation_xyz_cm": [ - 3.03941714614131, - -1.5349682758463712, - 7.5402063648831605 - ], - "translation_norm_m": 0.08273384810410857, - "rotation_rpy_deg_xyz": [ - 0.36259104517619084, - 0.06185223683678944, - -0.3442706336544428 - ], - "rotation_angle_deg": 0.5039390549857728, - "pair_index": 5, - "i": 1, - "j": 2 - }, - { - "translation_xyz_m": [ - 0.04175192484924195, - 0.00922782965761515, - 0.06593268253701975 - ], - "translation_xyz_cm": [ - 4.175192484924195, - 0.922782965761515, - 6.593268253701975 - ], - "translation_norm_m": 0.07858431583550332, - "rotation_rpy_deg_xyz": [ - 0.6786232936253767, - 0.36376569906588635, - -0.36097828409027216 - ], - "rotation_angle_deg": 0.8513002721677722, - "pair_index": 6, - "i": 1, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.0012114078621880409, - -0.0016856796441402366, - 0.0029253810122216103 - ], - "translation_xyz_cm": [ - -0.12114078621880409, - -0.16856796441402366, - 0.29253810122216106 - ], - "translation_norm_m": 0.0035870432026819093, - "rotation_rpy_deg_xyz": [ - 0.9426303288087607, - 0.24507818632054507, - 0.020386755072845576 - ], - "rotation_angle_deg": 0.9741392658395046, - "pair_index": 7, - "i": 1, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.005370144341937, - 0.019762948360935922, - 0.0016390642451390265 - ], - "translation_xyz_cm": [ - 0.5370144341937, - 1.9762948360935924, - 0.16390642451390264 - ], - "translation_norm_m": 0.02054505073661175, - "rotation_rpy_deg_xyz": [ - 0.33663978674929423, - 0.23438366247184536, - -0.025320892185126648 - ], - "rotation_angle_deg": 0.41102056376425117, - "pair_index": 8, - "i": 2, - "j": 3 - }, - { - "translation_xyz_m": [ - -0.037555965557714045, - -0.000881454353622857, - -0.03454520830943011 - ], - "translation_xyz_cm": [ - -3.7555965557714046, - -0.0881454353622857, - -3.454520830943011 - ], - "translation_norm_m": 0.05103527140999294, - "rotation_rpy_deg_xyz": [ - 0.7112686540591545, - 0.8835902165009863, - 0.5757505925688086 - ], - "rotation_angle_deg": 1.2695618641147897, - "pair_index": 9, - "i": 2, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.04908566588271285, - -0.022970277279778073, - -0.04338565579974829 - ], - "translation_xyz_cm": [ - -4.908566588271285, - -2.2970277279778073, - -4.338565579974829 - ], - "translation_norm_m": 0.06942154825868868, - "rotation_rpy_deg_xyz": [ - 0.7934266378138216, - 1.4177856745388515, - 0.4927363875445556 - ], - "rotation_angle_deg": 1.6949067031121938, - "pair_index": 10, - "i": 2, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.03198047329611266, - -0.018944859454277485, - -0.042780194251385295 - ], - "translation_xyz_cm": [ - -3.1980473296112657, - -1.8944859454277485, - -4.278019425138529 - ], - "translation_norm_m": 0.056672774699779445, - "rotation_rpy_deg_xyz": [ - 0.5301095135140876, - 0.4797815990997577, - 0.5980872587711318 - ], - "rotation_angle_deg": 0.9307274823147822, - "pair_index": 11, - "i": 3, - "j": 4 - }, - { - "translation_xyz_m": [ - -0.03924725092227816, - -0.03885493902365894, - -0.051410799364327256 - ], - "translation_xyz_cm": [ - -3.924725092227816, - -3.8854939023658943, - -5.1410799364327255 - ], - "translation_norm_m": 0.07545278843599904, - "rotation_rpy_deg_xyz": [ - 0.7406777446660229, - 0.9837317035119634, - 0.5174743722263418 - ], - "rotation_angle_deg": 1.3332317227955535, - "pair_index": 12, - "i": 3, - "j": 5 - }, - { - "translation_xyz_m": [ - -0.011992368032456763, - -0.012969618071286215, - -0.009685303707235176 - ], - "translation_xyz_cm": [ - -1.1992368032456762, - -1.2969618071286215, - -0.9685303707235176 - ], - "translation_norm_m": 0.02014529701548995, - "rotation_rpy_deg_xyz": [ - 0.38785709451857175, - 0.3495858886889525, - -0.08705446415902106 - ], - "rotation_angle_deg": 0.5295539563230257, - "pair_index": 13, - "i": 4, - "j": 5 - }, - { - "translation_xyz_m": [ - 0.012461298928039655, - -0.007796196898968918, - -0.1912490427814099 - ], - "translation_xyz_cm": [ - 1.2461298928039655, - -0.7796196898968919, - -19.12490427814099 - ], - "translation_norm_m": 0.19181308876577483, - "rotation_rpy_deg_xyz": [ - -0.8714863889544837, - 0.06298456568900439, - 0.3310526381993079 - ], - "rotation_angle_deg": 0.9345407340946447, - "pair_index": 14, - "i": 4, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.0033213432026311107, - 0.014302351663883819, - -0.2362038907950546 - ], - "translation_xyz_cm": [ - 0.33213432026311107, - 1.4302351663883819, - -23.62038907950546 - ], - "translation_norm_m": 0.23665981198866262, - "rotation_rpy_deg_xyz": [ - -0.5535749283448295, - -0.22435758897423883, - 0.4316530615420694 - ], - "rotation_angle_deg": 0.7363206713983871, - "pair_index": 15, - "i": 5, - "j": 7 - }, - { - "translation_xyz_m": [ - -0.002679148456035896, - 0.0034900557666657783, - -0.02189079734088116 - ], - "translation_xyz_cm": [ - -0.2679148456035896, - 0.34900557666657783, - -2.189079734088116 - ], - "translation_norm_m": 0.02232857662108013, - "rotation_rpy_deg_xyz": [ - 0.12242996017224908, - -0.07544176478257476, - -0.09917566305373922 - ], - "rotation_angle_deg": 0.1746435577976648, - "pair_index": 16, - "i": 5, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.0003661862227035406, - 0.033029119769420134, - -0.2653059473350433 - ], - "translation_xyz_cm": [ - -0.03661862227035406, - 3.3029119769420134, - -26.53059473350433 - ], - "translation_norm_m": 0.26735426410745194, - "rotation_rpy_deg_xyz": [ - -0.6268743701120475, - -0.0899960514267489, - 0.06819689901760526 - ], - "rotation_angle_deg": 0.6369099654382248, - "pair_index": 17, - "i": 5, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.003974386664717722, - 0.020041413271001285, - -0.1613945388970443 - ], - "translation_xyz_cm": [ - -0.3974386664717722, - 2.0041413271001285, - -16.13945388970443 - ], - "translation_norm_m": 0.16268267019276916, - "rotation_rpy_deg_xyz": [ - -0.5298420205475538, - 0.7331699857076515, - 0.2762349016326082 - ], - "rotation_angle_deg": 0.9468072491989274, - "pair_index": 18, - "i": 6, - "j": 7 - }, - { - "translation_xyz_m": [ - 0.004330490981893753, - 0.02742863412539598, - 0.00940855661580571 - ], - "translation_xyz_cm": [ - 0.4330490981893753, - 2.742863412539598, - 0.940855661580571 - ], - "translation_norm_m": 0.02931900509433977, - "rotation_rpy_deg_xyz": [ - 0.2642487181113795, - -0.8312384021288093, - -0.2515767376571775 - ], - "rotation_angle_deg": 0.9072533325217029, - "pair_index": 19, - "i": 6, - "j": 8 - }, - { - "translation_xyz_m": [ - -0.012104754832539477, - -0.031331786563014836, - -0.02393986090154049 - ], - "translation_xyz_cm": [ - -1.2104754832539477, - -3.133178656301484, - -2.3939860901540486 - ], - "translation_norm_m": 0.04124709539799514, - "rotation_rpy_deg_xyz": [ - 0.06763169804302002, - -0.33907715109670894, - -0.4802367868364451 - ], - "rotation_angle_deg": 0.5915926019510643, - "pair_index": 20, - "i": 7, - "j": 8 - }, - { - "translation_xyz_m": [ - 0.006773516076947539, - 0.00701360851491184, - -0.004777567950051249 - ], - "translation_xyz_cm": [ - 0.6773516076947539, - 0.701360851491184, - -0.4777567950051249 - ], - "translation_norm_m": 0.010858009944850278, - "rotation_rpy_deg_xyz": [ - 0.44261202761711155, - -0.601736452980534, - -0.4831589993919048 - ], - "rotation_angle_deg": 0.888360142832312, - "pair_index": 21, - "i": 7, - "j": 9 - }, - { - "translation_xyz_m": [ - -0.02519069821292197, - 0.018529016687797828, - -0.20145254685962313 - ], - "translation_xyz_cm": [ - -2.519069821292197, - 1.8529016687797828, - -20.145254685962314 - ], - "translation_norm_m": 0.20386521128456384, - "rotation_rpy_deg_xyz": [ - -0.6549444331810688, - 0.9454238796571128, - -0.6411517255029519 - ], - "rotation_angle_deg": 1.3141162595896627, - "pair_index": 22, - "i": 7, - "j": 11 - }, - { - "translation_xyz_m": [ - -0.03899457917677455, - 0.031185890471044697, - -0.2234738964802932 - ], - "translation_xyz_cm": [ - -3.899457917677455, - 3.1185890471044697, - -22.34738964802932 - ], - "translation_norm_m": 0.22898410289304044, - "rotation_rpy_deg_xyz": [ - -0.15842786720352073, - 0.8143631630688583, - -0.41200851399517047 - ], - "rotation_angle_deg": 0.9258005307494628, - "pair_index": 23, - "i": 7, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.010371926137968113, - 0.031533432779650705, - -0.035536331139737 - ], - "translation_xyz_cm": [ - 1.0371926137968113, - 3.1533432779650705, - -3.5536331139737 - ], - "translation_norm_m": 0.04862885013603815, - "rotation_rpy_deg_xyz": [ - 0.3499168876996315, - -0.11335075473918371, - -0.011973693588123153 - ], - "rotation_angle_deg": 0.3680017145989837, - "pair_index": 24, - "i": 8, - "j": 9 - }, - { - "translation_xyz_m": [ - 0.009464324610321873, - 0.04674701737960896, - -0.13579051898339942 - ], - "translation_xyz_cm": [ - 0.9464324610321873, - 4.674701737960896, - -13.57905189833994 - ], - "translation_norm_m": 0.14392332027854265, - "rotation_rpy_deg_xyz": [ - -0.5313552290312361, - -0.27832031757742437, - 0.16276072252893212 - ], - "rotation_angle_deg": 0.6211849404404554, - "pair_index": 25, - "i": 8, - "j": 10 - }, - { - "translation_xyz_m": [ - 0.004176906511918377, - 0.01978246726370969, - -0.08710790218756921 - ], - "translation_xyz_cm": [ - 0.4176906511918377, - 1.978246726370969, - -8.710790218756921 - ], - "translation_norm_m": 0.08942359410451012, - "rotation_rpy_deg_xyz": [ - -0.7502793178689087, - -0.14157482299150662, - 0.16180554413495643 - ], - "rotation_angle_deg": 0.7802838421023641, - "pair_index": 26, - "i": 9, - "j": 10 - }, - { - "translation_xyz_m": [ - -0.015946782478169608, - -0.01927748910392868, - -0.1636231100623713 - ], - "translation_xyz_cm": [ - -1.5946782478169608, - -1.927748910392868, - -16.362311006237128 - ], - "translation_norm_m": 0.1655247522397814, - "rotation_rpy_deg_xyz": [ - -0.850421197810317, - 2.259974110880241, - -0.37324635202135903 - ], - "rotation_angle_deg": 2.4407739487514912, - "pair_index": 27, - "i": 10, - "j": 11 - }, - { - "translation_xyz_m": [ - 0.0020255187804396613, - 0.02210686199981582, - -0.021406002614200538 - ], - "translation_xyz_cm": [ - 0.20255187804396613, - 2.210686199981582, - -2.1406002614200537 - ], - "translation_norm_m": 0.030838823287018827, - "rotation_rpy_deg_xyz": [ - 1.0019016401423093, - 0.09209745150596131, - 0.2191450295372474 - ], - "rotation_angle_deg": 1.0295431056764426, - "pair_index": 28, - "i": 11, - "j": 12 - }, - { - "translation_xyz_m": [ - 0.003394852381382263, - 0.042208453623284736, - 0.06074491487005579 - ], - "translation_xyz_cm": [ - 0.3394852381382263, - 4.220845362328474, - 6.074491487005579 - ], - "translation_norm_m": 0.07404743927058302, - "rotation_rpy_deg_xyz": [ - 1.1458312633579382, - 1.5653220513390178, - 0.1541310784022397 - ], - "rotation_angle_deg": 1.944739037557661, - "pair_index": 29, - "i": 11, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.01825988423666791, - 0.0016187458232161944, - -0.022940466904468534 - ], - "translation_xyz_cm": [ - -1.8259884236667911, - 0.16187458232161944, - -2.2940466904468533 - ], - "translation_norm_m": 0.029365093770865255, - "rotation_rpy_deg_xyz": [ - -0.10107722918942118, - 2.2989243210632977, - 0.6888586653782028 - ], - "rotation_angle_deg": 2.402607849811502, - "pair_index": 30, - "i": 11, - "j": 14 - }, - { - "translation_xyz_m": [ - -0.0004984401771205293, - 0.006685868678856011, - 0.3870743509780252 - ], - "translation_xyz_cm": [ - -0.049844017712052935, - 0.6685868678856011, - 38.70743509780252 - ], - "translation_norm_m": 0.38713240947724914, - "rotation_rpy_deg_xyz": [ - -1.1949945190290059, - 0.3867227936693216, - -0.062180096084887476 - ], - "rotation_angle_deg": 1.2573486710805661, - "pair_index": 31, - "i": 11, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.009390664323436493, - 0.04221622273535053, - 0.04995850695747302 - ], - "translation_xyz_cm": [ - 0.9390664323436493, - 4.221622273535052, - 4.9958506957473015 - ], - "translation_norm_m": 0.06607757907108938, - "rotation_rpy_deg_xyz": [ - 1.41823154782434, - -0.37351388423595594, - 0.056605451472076004 - ], - "rotation_angle_deg": 1.4678602012812054, - "pair_index": 32, - "i": 12, - "j": 13 - }, - { - "translation_xyz_m": [ - -0.01031227742298424, - 0.015920431218789055, - 0.0063433679289610885 - ], - "translation_xyz_cm": [ - -1.031227742298424, - 1.5920431218789055, - 0.6343367928961089 - ], - "translation_norm_m": 0.020001037786148892, - "rotation_rpy_deg_xyz": [ - 0.0964010113907586, - 1.9693817150237038, - 0.4849368785656174 - ], - "rotation_angle_deg": 2.030096131128867, - "pair_index": 33, - "i": 12, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.023449036534887058, - 0.02875958174602644, - 0.1514488272482756 - ], - "translation_xyz_cm": [ - 2.3449036534887058, - 2.875958174602644, - 15.14488272482756 - ], - "translation_norm_m": 0.15592856740026464, - "rotation_rpy_deg_xyz": [ - -0.03748910221010643, - -0.9361241695856968, - -0.30010823429897965 - ], - "rotation_angle_deg": 0.9838600654422205, - "pair_index": 34, - "i": 12, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.005142198738700435, - 0.018153990644617313, - 0.38723933271021915 - ], - "translation_xyz_cm": [ - -0.5142198738700434, - 1.8153990644617313, - 38.72393327102191 - ], - "translation_norm_m": 0.3876987366268414, - "rotation_rpy_deg_xyz": [ - -0.5311916053182185, - 0.34563564492307863, - -0.2452204412312245 - ], - "rotation_angle_deg": 0.678950905141144, - "pair_index": 35, - "i": 12, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.013894668686479372, - 0.01101739113685929, - 0.058100551088268115 - ], - "translation_xyz_cm": [ - -1.3894668686479372, - 1.101739113685929, - 5.810055108826812 - ], - "translation_norm_m": 0.06074634772667431, - "rotation_rpy_deg_xyz": [ - 0.8751601758841604, - 2.5470806194099076, - 0.5917116810425564 - ], - "rotation_angle_deg": 2.7532592440494765, - "pair_index": 36, - "i": 13, - "j": 14 - }, - { - "translation_xyz_m": [ - 0.031163796694808066, - 0.011959732943482848, - 0.18548162350437347 - ], - "translation_xyz_cm": [ - 3.1163796694808066, - 1.1959732943482848, - 18.548162350437348 - ], - "translation_norm_m": 0.18846126948084826, - "rotation_rpy_deg_xyz": [ - 0.26042733216370795, - -0.3474619528536646, - -0.22819641071055743 - ], - "rotation_angle_deg": 0.4901682902383377, - "pair_index": 37, - "i": 13, - "j": 15 - }, - { - "translation_xyz_m": [ - 0.02839924352458212, - 0.023391804403995575, - 0.3163142135683885 - ], - "translation_xyz_cm": [ - 2.839924352458212, - 2.3391804403995575, - 31.63142135683885 - ], - "translation_norm_m": 0.31844681699057914, - "rotation_rpy_deg_xyz": [ - 0.11050162149875127, - -0.11834298782643238, - -0.24015309961141135 - ], - "rotation_angle_deg": 0.2895415816677478, - "pair_index": 38, - "i": 13, - "j": 16 - }, - { - "translation_xyz_m": [ - 0.024443881205113982, - 0.026747444902408102, - 0.07607612364052282 - ], - "translation_xyz_cm": [ - 2.444388120511398, - 2.67474449024081, - 7.607612364052282 - ], - "translation_norm_m": 0.0842644986061461, - "rotation_rpy_deg_xyz": [ - 0.8637339453585897, - -2.382016409532787, - -0.7937090222621448 - ], - "rotation_angle_deg": 2.649773797051862, - "pair_index": 39, - "i": 14, - "j": 15 - }, - { - "translation_xyz_m": [ - -0.020042767658092764, - 0.037656521373930385, - 0.21376847499872056 - ], - "translation_xyz_cm": [ - -2.0042767658092764, - 3.7656521373930385, - 21.376847499872056 - ], - "translation_norm_m": 0.21798322651217958, - "rotation_rpy_deg_xyz": [ - 0.6416163681111158, - -0.768162938994497, - -0.7372200176480626 - ], - "rotation_angle_deg": 1.2405150413124717, - "pair_index": 40, - "i": 14, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.005034532093224353, - -0.01467418732076009, - 0.16759200793255422 - ], - "translation_xyz_cm": [ - -0.5034532093224353, - -1.467418732076009, - 16.75920079325542 - ], - "translation_norm_m": 0.16830852447154238, - "rotation_rpy_deg_xyz": [ - -1.0472249088726615, - 0.5013606987807923, - -0.026181905990093984 - ], - "rotation_angle_deg": 1.1612411936043423, - "pair_index": 41, - "i": 15, - "j": 16 - }, - { - "translation_xyz_m": [ - -0.0030754998808334433, - -0.004883489293975529, - -0.05209434789617402 - ], - "translation_xyz_cm": [ - -0.30754998808334433, - -0.4883489293975529, - -5.2094347896174025 - ], - "translation_norm_m": 0.05241305419386463, - "rotation_rpy_deg_xyz": [ - -0.44566905285740044, - 0.35450780958571715, - 0.08680034472550638 - ], - "rotation_angle_deg": 0.5762548463344785, - "pair_index": 42, - "i": 17, - "j": 18 - }, - { - "translation_xyz_m": [ - -0.0038314394040863675, - 0.0397793553938568, - 0.06738788437174513 - ], - "translation_xyz_cm": [ - -0.38314394040863675, - 3.9779355393856797, - 6.738788437174513 - ], - "translation_norm_m": 0.07834669108237846, - "rotation_rpy_deg_xyz": [ - -0.8256077059672355, - -0.009959579152789654, - -0.7179050531309007 - ], - "rotation_angle_deg": 1.094170485243448, - "pair_index": 43, - "i": 18, - "j": 19 - }, - { - "translation_xyz_m": [ - 0.010680805617082623, - -0.05047466749839269, - -0.0041449251991997746 - ], - "translation_xyz_cm": [ - 1.0680805617082623, - -5.047466749839269, - -0.41449251991997743 - ], - "translation_norm_m": 0.051758594190821725, - "rotation_rpy_deg_xyz": [ - 0.12815174377162655, - 0.1926555214552762, - -0.6298449851624462 - ], - "rotation_angle_deg": 0.6712038249104364, - "pair_index": 44, - "i": 20, - "j": 21 - }, - { - "translation_xyz_m": [ - -0.012825092080585243, - -0.005307101405562786, - 0.012804594366679668 - ], - "translation_xyz_cm": [ - -1.2825092080585243, - -0.5307101405562786, - 1.280459436667967 - ], - "translation_norm_m": 0.01888401305601173, - "rotation_rpy_deg_xyz": [ - 0.5666930866394815, - -0.3480109427812121, - -0.7057018979090687 - ], - "rotation_angle_deg": 0.9684173657810843, - "pair_index": 45, - "i": 20, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.00828964319858061, - 0.01279147298717831, - -0.06089698241216452 - ], - "translation_xyz_cm": [ - 0.828964319858061, - 1.279147298717831, - -6.089698241216452 - ], - "translation_norm_m": 0.06277565158920265, - "rotation_rpy_deg_xyz": [ - 0.46659986442537754, - 0.1133091399799631, - 0.14049235731974521 - ], - "rotation_angle_deg": 0.5001626440435895, - "pair_index": 46, - "i": 21, - "j": 22 - }, - { - "translation_xyz_m": [ - 0.015018777842916609, - 0.00782827689932164, - 0.020712089370448758 - ], - "translation_xyz_cm": [ - 1.5018777842916609, - 0.782827689932164, - 2.071208937044876 - ], - "translation_norm_m": 0.026755116392884408, - "rotation_rpy_deg_xyz": [ - 1.1774372986719865, - 0.775502743983497, - 0.02084305400134559 - ], - "rotation_angle_deg": 1.4099092788351706, - "pair_index": 47, - "i": 21, - "j": 26 - }, - { - "translation_xyz_m": [ - 0.008423507736994296, - -0.030464601960980386, - -0.02108725529085015 - ], - "translation_xyz_cm": [ - 0.8423507736994296, - -3.046460196098039, - -2.1087255290850146 - ], - "translation_norm_m": 0.03799631285977181, - "rotation_rpy_deg_xyz": [ - -1.3982262497388964, - -1.1259285808375894, - 0.14905424095907965 - ], - "rotation_angle_deg": 1.800224630297897, - "pair_index": 48, - "i": 22, - "j": 23 - }, - { - "translation_xyz_m": [ - 0.014907012225855443, - 0.000371897201273938, - 0.021942409852584888 - ], - "translation_xyz_cm": [ - 1.4907012225855443, - 0.0371897201273938, - 2.1942409852584888 - ], - "translation_norm_m": 0.02652973183371693, - "rotation_rpy_deg_xyz": [ - -0.37632919589740194, - -0.7842516287454125, - -0.1336953761870536 - ], - "rotation_angle_deg": 0.8804742241525628, - "pair_index": 49, - "i": 22, - "j": 24 - }, - { - "translation_xyz_m": [ - 0.0010623601023973528, - -0.031018408548779963, - 0.035573891504942196 - ], - "translation_xyz_cm": [ - 0.10623601023973528, - -3.101840854877996, - 3.5573891504942194 - ], - "translation_norm_m": 0.047209872216429374, - "rotation_rpy_deg_xyz": [ - 1.3368495013325015, - -0.2935449483441324, - -0.20656643018409035 - ], - "rotation_angle_deg": 1.3836850003764838, - "pair_index": 50, - "i": 22, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.007468214668533646, - 0.02127980518350192, - -0.06130504668353355 - ], - "translation_xyz_cm": [ - 0.7468214668533646, - 2.127980518350192, - -6.130504668353355 - ], - "translation_norm_m": 0.06532161271626202, - "rotation_rpy_deg_xyz": [ - 0.49997966135971217, - 1.4267705196344584, - 0.09663303001075217 - ], - "rotation_angle_deg": 1.514521422411775, - "pair_index": 51, - "i": 22, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.017160927413651272, - 0.030078297627226025, - 0.052796687148148405 - ], - "translation_xyz_cm": [ - -1.7160927413651272, - 3.0078297627226025, - 5.27966871481484 - ], - "translation_norm_m": 0.0631402533386433, - "rotation_rpy_deg_xyz": [ - 0.3796651795575131, - 0.8924741481689585, - -0.27998386331492386 - ], - "rotation_angle_deg": 1.0102958610703665, - "pair_index": 52, - "i": 23, - "j": 24 - }, - { - "translation_xyz_m": [ - -0.001032661614855268, - -0.042030479297787804, - -0.05721157824077381 - ], - "translation_xyz_cm": [ - -0.10326616148552681, - -4.20304792977878, - -5.721157824077381 - ], - "translation_norm_m": 0.07099853706107435, - "rotation_rpy_deg_xyz": [ - 0.1203217534843877, - 0.3083633764368611, - -0.09900145494346844 - ], - "rotation_angle_deg": 0.3455873727166648, - "pair_index": 53, - "i": 24, - "j": 25 - }, - { - "translation_xyz_m": [ - 0.012176715623726686, - 0.037173458632532075, - -0.04502513182476406 - ], - "translation_xyz_cm": [ - 1.2176715623726686, - 3.7173458632532075, - -4.502513182476406 - ], - "translation_norm_m": 0.059643951293681614, - "rotation_rpy_deg_xyz": [ - 0.0769979663731691, - 1.0329896574142907, - 0.21442432714579107 - ], - "rotation_angle_deg": 1.057674351612189, - "pair_index": 54, - "i": 24, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.02119752133347097, - 0.02029010893786487, - -0.07098510901736371 - ], - "translation_xyz_cm": [ - -2.119752133347097, - 2.029010893786487, - -7.098510901736371 - ], - "translation_norm_m": 0.07681086598652818, - "rotation_rpy_deg_xyz": [ - 0.6345384780044454, - 0.059366913438672286, - 0.36278648927038765 - ], - "rotation_angle_deg": 0.7331695785477718, - "pair_index": 55, - "i": 24, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.02021190936948747, - 0.012690762866823802, - -0.07685445352125084 - ], - "translation_xyz_cm": [ - -2.021190936948747, - 1.2690762866823802, - -7.685445352125083 - ], - "translation_norm_m": 0.08047473994088104, - "rotation_rpy_deg_xyz": [ - -0.052686244590517295, - 0.31253911220353925, - 0.06991131668061486 - ], - "rotation_angle_deg": 0.32459852438345793, - "pair_index": 56, - "i": 25, - "j": 26 - }, - { - "translation_xyz_m": [ - -0.02651096613062398, - 0.025605846934852905, - -0.05258238370409301 - ], - "translation_xyz_cm": [ - -2.651096613062398, - 2.5605846934852905, - -5.258238370409301 - ], - "translation_norm_m": 0.06421368855964181, - "rotation_rpy_deg_xyz": [ - 0.35254771196074464, - 0.41529878905663037, - 0.31369891928337934 - ], - "rotation_angle_deg": 0.6279865278118713, - "pair_index": 57, - "i": 25, - "j": 27 - }, - { - "translation_xyz_m": [ - -0.007849728561652336, - -0.009348609754393555, - -0.05630724814220328 - ], - "translation_xyz_cm": [ - -0.7849728561652336, - -0.9348609754393555, - -5.630724814220328 - ], - "translation_norm_m": 0.05761528387658276, - "rotation_rpy_deg_xyz": [ - 1.211333968577648, - 0.4487437980259796, - 0.48951859609825005 - ], - "rotation_angle_deg": 1.37973461425998, - "pair_index": 58, - "i": 25, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.017865485703217887, - -0.020214836280836312, - -0.01501678784364744 - ], - "translation_xyz_cm": [ - 1.7865485703217887, - -2.0214836280836312, - -1.5016787843647441 - ], - "translation_norm_m": 0.030875866018850652, - "rotation_rpy_deg_xyz": [ - 0.052405042324072136, - -0.27601698459724455, - -0.23159909548722377 - ], - "rotation_angle_deg": 0.36402091126448166, - "pair_index": 59, - "i": 25, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.010147829869174785, - 0.002192134827369241, - -0.03963506720423706 - ], - "translation_xyz_cm": [ - -1.0147829869174785, - 0.2192134827369241, - -3.963506720423706 - ], - "translation_norm_m": 0.040972215688677, - "rotation_rpy_deg_xyz": [ - 0.6978611581462265, - 0.3527107698480769, - 0.2636011965722604 - ], - "rotation_angle_deg": 0.8244790019644808, - "pair_index": 60, - "i": 26, - "j": 27 - }, - { - "translation_xyz_m": [ - 0.010194111729574518, - 0.013475771610900633, - 0.04710591588587727 - ], - "translation_xyz_cm": [ - 1.0194111729574518, - 1.3475771610900633, - 4.710591588587727 - ], - "translation_norm_m": 0.05004481637404167, - "rotation_rpy_deg_xyz": [ - 1.1608938182333446, - -0.5499443214310024, - -0.2901860375741654 - ], - "rotation_angle_deg": 1.3157027909945098, - "pair_index": 61, - "i": 26, - "j": 28 - }, - { - "translation_xyz_m": [ - -0.008672783511003423, - 0.005759303035275609, - 0.015064051207492477 - ], - "translation_xyz_cm": [ - -0.8672783511003423, - 0.5759303035275609, - 1.5064051207492477 - ], - "translation_norm_m": 0.018311536911543587, - "rotation_rpy_deg_xyz": [ - 1.1724458487610898, - 0.38454710171940987, - 0.41466722954668844 - ], - "rotation_angle_deg": 1.3004537014787485, - "pair_index": 62, - "i": 26, - "j": 29 - }, - { - "translation_xyz_m": [ - -0.0008144682904442924, - -0.009652031992887, - -0.021672195072584194 - ], - "translation_xyz_cm": [ - -0.08144682904442924, - -0.9652031992887, - -2.1672195072584195 - ], - "translation_norm_m": 0.023738347024424344, - "rotation_rpy_deg_xyz": [ - -0.24805247931709, - 0.447043033408938, - -0.2960401906750366 - ], - "rotation_angle_deg": 0.590290988836907, - "pair_index": 63, - "i": 26, - "j": 30 - }, - { - "translation_xyz_m": [ - 0.01978566612993049, - 0.030678683419452124, - 0.12916238887632647 - ], - "translation_xyz_cm": [ - 1.978566612993049, - 3.0678683419452124, - 12.916238887632648 - ], - "translation_norm_m": 0.13422211777794088, - "rotation_rpy_deg_xyz": [ - 1.637630152008551, - -0.38792075849245466, - -0.5054951709301369 - ], - "rotation_angle_deg": 1.7556215623216629, - "pair_index": 64, - "i": 27, - "j": 28 - }, - { - "translation_xyz_m": [ - 0.008595060105936803, - 0.0033626722283979227, - 0.08000115790075184 - ], - "translation_xyz_cm": [ - 0.8595060105936803, - 0.33626722283979227, - 8.000115790075183 - ], - "translation_norm_m": 0.08053178185164744, - "rotation_rpy_deg_xyz": [ - 1.18153709530713, - 0.07856176925752208, - 0.17619509068717787 - ], - "rotation_angle_deg": 1.1970629873046434, - "pair_index": 65, - "i": 27, - "j": 29 - }, - { - "translation_xyz_m": [ - 0.014850906143264009, - 0.01003894967591612, - 0.028321016430231938 - ], - "translation_xyz_cm": [ - 1.4850906143264009, - 1.003894967591612, - 2.8321016430231936 - ], - "translation_norm_m": 0.03351730740249104, - "rotation_rpy_deg_xyz": [ - 0.8518687506863247, - 0.7950709932976321, - -0.5119528344057716 - ], - "rotation_angle_deg": 1.2751255223416527, - "pair_index": 66, - "i": 27, - "j": 30 - }, - { - "translation_xyz_m": [ - -0.005773560675030431, - 0.025255088106992618, - 0.07327526685947254 - ], - "translation_xyz_cm": [ - -0.5773560675030431, - 2.525508810699262, - 7.327526685947254 - ], - "translation_norm_m": 0.07772012745413592, - "rotation_rpy_deg_xyz": [ - -1.1567443476507144, - -0.3034026186350333, - 0.6259564042690632 - ], - "rotation_angle_deg": 1.3483621448904275, - "pair_index": 67, - "i": 30, - "j": 31 - }, - { - "translation_xyz_m": [ - 0.010274928684473217, - 0.006137051644713232, - 0.04990631525963336 - ], - "translation_xyz_cm": [ - 1.0274928684473217, - 0.6137051644713232, - 4.9906315259633365 - ], - "translation_norm_m": 0.051321319791630474, - "rotation_rpy_deg_xyz": [ - -0.3157056005174439, - -0.09866317517778897, - 0.5086180088624361 - ], - "rotation_angle_deg": 0.60648122558066, - "pair_index": 68, - "i": 30, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.007271572446396535, - -0.037595151091622314, - 0.005056866696097381 - ], - "translation_xyz_cm": [ - -0.7271572446396535, - -3.7595151091622316, - 0.5056866696097382 - ], - "translation_norm_m": 0.03862438416631653, - "rotation_rpy_deg_xyz": [ - 0.26841365800645883, - -0.5464657830011603, - -0.11861641353998834 - ], - "rotation_angle_deg": 0.6200292390814335, - "pair_index": 69, - "i": 31, - "j": 32 - }, - { - "translation_xyz_m": [ - -0.03780044869732735, - 0.04525129131801808, - -0.05636933319549976 - ], - "translation_xyz_cm": [ - -3.780044869732735, - 4.525129131801808, - -5.636933319549977 - ], - "translation_norm_m": 0.0815723912397613, - "rotation_rpy_deg_xyz": [ - -0.9689272174930074, - -0.8878421047793786, - -0.05527192058144009 - ], - "rotation_angle_deg": 1.3156555357860478, - "pair_index": 70, - "i": 31, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.0030575365884524253, - 0.0617849373979239, - -0.01407876209494413 - ], - "translation_xyz_cm": [ - 0.3057536588452425, - 6.1784937397923905, - -1.407876209494413 - ], - "translation_norm_m": 0.06344240349625112, - "rotation_rpy_deg_xyz": [ - -0.5783228386525225, - -0.4586973640577997, - -0.07521770584523312 - ], - "rotation_angle_deg": 0.7422025791537007, - "pair_index": 71, - "i": 31, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.0017615790293055156, - -0.014856588100796375, - 0.027049500786485825 - ], - "translation_xyz_cm": [ - -0.17615790293055156, - -1.4856588100796375, - 2.7049500786485825 - ], - "translation_norm_m": 0.030911112297542943, - "rotation_rpy_deg_xyz": [ - 0.45791063284073463, - -1.087694877361352, - 0.2365296685416879 - ], - "rotation_angle_deg": 1.204473508999244, - "pair_index": 72, - "i": 32, - "j": 33 - }, - { - "translation_xyz_m": [ - -0.024623918960102742, - -0.0023820534945180882, - 0.03756062094578779 - ], - "translation_xyz_cm": [ - -2.462391896010274, - -0.23820534945180882, - 3.756062094578779 - ], - "translation_norm_m": 0.04497568020205593, - "rotation_rpy_deg_xyz": [ - -0.46984987433313913, - -1.0657670650363915, - 0.17726930897973578 - ], - "rotation_angle_deg": 1.1774914068251934, - "pair_index": 73, - "i": 32, - "j": 34 - }, - { - "translation_xyz_m": [ - -0.005336530562001229, - 0.029719843216789443, - -0.039106199270714764 - ], - "translation_xyz_cm": [ - -0.5336530562001229, - 2.9719843216789443, - -3.9106199270714765 - ], - "translation_norm_m": 0.049406907013802945, - "rotation_rpy_deg_xyz": [ - 0.2645819013402327, - -0.3574711260848621, - 0.1059358582326404 - ], - "rotation_angle_deg": 0.45736876108030977, - "pair_index": 74, - "i": 32, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.010734565399595164, - 0.034782397584407265, - -0.08061667432566111 - ], - "translation_xyz_cm": [ - 1.0734565399595164, - 3.4782397584407265, - -8.06166743256611 - ], - "translation_norm_m": 0.08845391034526215, - "rotation_rpy_deg_xyz": [ - 1.0967208366474215, - -0.36843441284759376, - 0.10025023977270257 - ], - "rotation_angle_deg": 1.1615907773284926, - "pair_index": 75, - "i": 32, - "j": 36 - }, - { - "translation_xyz_m": [ - -0.008871918840051896, - -0.0011432252795349207, - -0.007219811808539204 - ], - "translation_xyz_cm": [ - -0.8871918840051896, - -0.11432252795349207, - -0.7219811808539204 - ], - "translation_norm_m": 0.01149537256877556, - "rotation_rpy_deg_xyz": [ - 0.31510152128942615, - -0.0962419720064821, - -0.04851449364507556 - ], - "rotation_angle_deg": 0.33298563632398837, - "pair_index": 76, - "i": 33, - "j": 34 - }, - { - "translation_xyz_m": [ - 0.0165887184186011, - 0.034494564890754864, - -0.04555660056762515 - ], - "translation_xyz_cm": [ - 1.65887184186011, - 3.4494564890754864, - -4.555660056762515 - ], - "translation_norm_m": 0.05950180199836201, - "rotation_rpy_deg_xyz": [ - 0.8572407591137061, - 0.30869404995000804, - -0.13744200351872368 - ], - "rotation_angle_deg": 0.9217790684541854, - "pair_index": 77, - "i": 33, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.023885454817077267, - 0.032863908816594956, - 0.03222652413127444 - ], - "translation_xyz_cm": [ - 2.3885454817077267, - 3.2863908816594956, - 3.2226524131274443 - ], - "translation_norm_m": 0.051856535866828986, - "rotation_rpy_deg_xyz": [ - 1.0682532467877768, - 0.36874200627839215, - -0.08137983277094685 - ], - "rotation_angle_deg": 1.133275640950988, - "pair_index": 78, - "i": 34, - "j": 35 - }, - { - "translation_xyz_m": [ - 0.00013743435839375095, - 0.0018089796987820206, - 0.015181346272477872 - ], - "translation_xyz_cm": [ - 0.013743435839375095, - 0.18089796987820206, - 1.5181346272477871 - ], - "translation_norm_m": 0.015289361346974254, - "rotation_rpy_deg_xyz": [ - 0.7286328738875988, - -0.049454412865246815, - 0.008945252879816231 - ], - "rotation_angle_deg": 0.7303678615326775, - "pair_index": 79, - "i": 35, - "j": 36 - } - ], - "comparison_to_baseline": { - "normalized_global_rms_change": 0.009952110048927043, - "improved_pairs": 27, - "worsened_pairs": 53, - "unchanged_pairs": 0, - "median_per_pair_score_change": 0.005036973923611132, - "global_consistency_signal": false - } - } - ] -} diff --git a/results/01_previous_two_batches/final_extrinsic_deployment.json b/results/01_previous_two_batches/final_extrinsic_deployment.json deleted file mode 100644 index 43f7022..0000000 --- a/results/01_previous_two_batches/final_extrinsic_deployment.json +++ /dev/null @@ -1,46 +0,0 @@ -{ - "convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame", - "translation_m": [ - 1.2977596922478565, - -0.00006733076264476427, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ], - "quaternion_xyzw": [ - -0.0067746045444860015, - 0.010544431385358818, - -0.0072186568687935965, - 0.9998953998759249 - ], - "matrix_4x4": [ - [ - 0.9996734119195402, - 0.014292934887214408, - 0.021184463964312037, - 1.2977596922478565 - ], - [ - -0.01457867229834346, - 0.9998039914525529, - 0.013395558575925315, - -0.00006733076264476427 - ], - [ - -0.020988849781798404, - -0.013700025104115046, - 0.9996858394000506, - 0.7204978345266887 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ] -} - diff --git a/results/01_previous_two_batches/final_extrinsic_recommended.json b/results/01_previous_two_batches/final_extrinsic_recommended.json deleted file mode 100644 index bdfe44e..0000000 --- a/results/01_previous_two_batches/final_extrinsic_recommended.json +++ /dev/null @@ -1,405 +0,0 @@ -{ - "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.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ], - "quaternion_xyzw": [ - -0.0067746045444860015, - 0.010544431385358818, - -0.0072186568687935965, - 0.9998953998759249 - ], - "matrix_4x4": [ - [ - 0.9996734119195402, - 0.014292934887214408, - 0.021184463964312037, - 1.2977596922478565 - ], - [ - -0.01457867229834346, - 0.9998039914525529, - 0.013395558575925315, - -6.733076264476427e-05 - ], - [ - -0.020988849781798404, - -0.013700025104115046, - 0.9996858394000506, - 0.7204978345266887 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 38, - "pairs": 39, - "residuals": { - "pairs": 39, - "translation_m": { - "rms": 0.07984780651249465, - "median": 0.05392926910429046, - "p90": 0.11822807898946641, - "p95": 0.14420733112402187, - "max": 0.2330103519747209 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011372, - "p90": 1.422624767604584, - "p95": 1.4793113785217964, - "max": 1.7237415928660533 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.1353760421849012, - "rotation_deg": 0.5166365681634405 - }, - { - "pair_index": 1, - "translation_m": 0.11487543918383647, - "rotation_deg": 0.5717221816616095 - }, - { - "pair_index": 2, - "translation_m": 0.06210064976174764, - "rotation_deg": 0.4402983357286552 - }, - { - "pair_index": 3, - "translation_m": 0.054355548674489614, - "rotation_deg": 0.5821611725015269 - }, - { - "pair_index": 4, - "translation_m": 0.02391657882546618, - "rotation_deg": 0.32738975448002894 - }, - { - "pair_index": 5, - "translation_m": 0.07775220171630512, - "rotation_deg": 0.8706732532310371 - }, - { - "pair_index": 6, - "translation_m": 0.06265840922697155, - "rotation_deg": 0.8002960897011372 - }, - { - "pair_index": 7, - "translation_m": 0.09282561040685418, - "rotation_deg": 1.0484294819479303 - }, - { - "pair_index": 8, - "translation_m": 0.034474807960716856, - "rotation_deg": 0.40941928556312257 - }, - { - "pair_index": 9, - "translation_m": 0.13163863821198593, - "rotation_deg": 1.1065820279922887 - }, - { - "pair_index": 10, - "translation_m": 0.0018609877360485794, - "rotation_deg": 0.6081452332544832 - }, - { - "pair_index": 11, - "translation_m": 0.06488404028756532, - "rotation_deg": 0.05192051717362457 - }, - { - "pair_index": 12, - "translation_m": 0.1147488321233841, - "rotation_deg": 0.9937108406424444 - }, - { - "pair_index": 13, - "translation_m": 0.05392926910429046, - "rotation_deg": 0.9700546737541248 - }, - { - "pair_index": 14, - "translation_m": 0.02302185790244543, - "rotation_deg": 1.6149869587730064 - }, - { - "pair_index": 15, - "translation_m": 0.2330103519747209, - "rotation_deg": 0.5939965715201481 - }, - { - "pair_index": 16, - "translation_m": 0.2236889315761065, - "rotation_deg": 1.1151964340680336 - }, - { - "pair_index": 17, - "translation_m": 0.04090994021171706, - "rotation_deg": 0.7785618518380144 - }, - { - "pair_index": 18, - "translation_m": 0.054652520003134704, - "rotation_deg": 1.124375763416717 - }, - { - "pair_index": 19, - "translation_m": 0.04547500551567543, - "rotation_deg": 0.6556954445211121 - }, - { - "pair_index": 20, - "translation_m": 0.02484690940972022, - "rotation_deg": 1.7237415928660533 - }, - { - "pair_index": 21, - "translation_m": 0.056832852413462566, - "rotation_deg": 0.5831473606925555 - }, - { - "pair_index": 22, - "translation_m": 0.03998842216950218, - "rotation_deg": 1.124691549503354 - }, - { - "pair_index": 23, - "translation_m": 0.052224143195848054, - "rotation_deg": 1.1184574012171749 - }, - { - "pair_index": 24, - "translation_m": 0.06305629062353875, - "rotation_deg": 0.5252019728243343 - }, - { - "pair_index": 25, - "translation_m": 0.0552093328283033, - "rotation_deg": 0.08705258513790126 - }, - { - "pair_index": 26, - "translation_m": 0.08502281683725502, - "rotation_deg": 0.6459827373704314 - }, - { - "pair_index": 27, - "translation_m": 0.03727269737723399, - "rotation_deg": 0.7631660358041192 - }, - { - "pair_index": 28, - "translation_m": 0.04543722819346571, - "rotation_deg": 1.4218618784137362 - }, - { - "pair_index": 29, - "translation_m": 0.02559982081388642, - "rotation_deg": 1.388947601285772 - }, - { - "pair_index": 30, - "translation_m": 0.01827234061769129, - "rotation_deg": 1.206866980510853 - }, - { - "pair_index": 31, - "translation_m": 0.06863732394647468, - "rotation_deg": 1.4642363140494394 - }, - { - "pair_index": 32, - "translation_m": 0.04770629220585725, - "rotation_deg": 0.6244903967618446 - }, - { - "pair_index": 33, - "translation_m": 0.027074935362624366, - "rotation_deg": 1.3688430767407767 - }, - { - "pair_index": 34, - "translation_m": 0.03301156138156032, - "rotation_deg": 1.4256763243679755 - }, - { - "pair_index": 35, - "translation_m": 0.054240160043693975, - "rotation_deg": 0.6486412679040612 - }, - { - "pair_index": 36, - "translation_m": 0.021992835671895014, - "rotation_deg": 0.23769553016909395 - }, - { - "pair_index": 37, - "translation_m": 0.031890552923517286, - "rotation_deg": 1.0832171246083164 - }, - { - "pair_index": 38, - "translation_m": 0.025286131886091672, - "rotation_deg": 1.2215923174512224 - } - ] - } - }, - "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.0061384486036208784, - 0.006616582082990767, - 0.004372364137893693 - ], - "rotation_deg": [ - 0.06746979098802125, - 0.05919345389075773, - 0.16157711056486687 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.965138763120991, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 152.7941369486616, - "success": true, - "translation_m": 5.01999140559543e-10, - "rotation_deg": 7.693408441139155e-09 - }, - { - "cost": 152.79413694866156, - "success": true, - "translation_m": 1.7788160768171148e-10, - "rotation_deg": 3.2213546311649044e-09 - }, - { - "cost": 152.7941369486616, - "success": true, - "translation_m": 2.04052729806573e-10, - "rotation_deg": 5.128825141169912e-09 - }, - { - "cost": 152.79413694866287, - "success": true, - "translation_m": 3.6987521890593636e-09, - "rotation_deg": 1.471926437983498e-07 - }, - { - "cost": 152.79413694866153, - "success": true, - "translation_m": 3.0367491381779985e-10, - "rotation_deg": 3.27791256123688e-09 - }, - { - "cost": 152.79413694866173, - "success": true, - "translation_m": 6.928454212106221e-10, - "rotation_deg": 2.8875952395155353e-08 - }, - { - "cost": 152.79413694866153, - "success": true, - "translation_m": 1.9628898247072475e-10, - "rotation_deg": 3.769277991759282e-09 - }, - { - "cost": 152.79413694866167, - "success": true, - "translation_m": 1.8108640246434077e-09, - "rotation_deg": 5.6964069970580913e-08 - }, - { - "cost": 152.79413694866145, - "success": true, - "translation_m": 0.0, - "rotation_deg": 0.0 - }, - { - "cost": 152.7941369486631, - "success": true, - "translation_m": 3.8878373558477815e-09, - "rotation_deg": 1.567977862312646e-07 - }, - { - "cost": 152.79413694866162, - "success": true, - "translation_m": 1.928688225276107e-09, - "rotation_deg": 6.007537452298471e-08 - }, - { - "cost": 152.79413694866165, - "success": true, - "translation_m": 6.380398519737792e-10, - "rotation_deg": 2.6596239917974983e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.003223574650236103, - 0.003334649335095665, - 0.0016858977028131694, - 0.0980155224808408, - 0.07461769310738842, - 0.11886090357304822 - ], - "p025": [ - 1.2916920074190312, - -0.005413227092587022, - 0.7171569502776788, - -0.9695959273616203, - 1.066246526462818, - -1.100751980508544 - ], - "p975": [ - 1.3034038047298853, - 0.007138524793626496, - 0.7235834879340349, - -0.6076030002143074, - 1.3517461178267727, - -0.6468477685453492 - ] - }, - "selection": { - "method": "Open3D B gated by Open3D-small_gicp cross-backend agreement", - "selection_is_X_independent": true, - "consensus_pair_threshold": "Open3D-small_gicp B delta <= 0.05 m and <= 0.50 deg", - "warning": "AX rotation RMS remains about one degree; this is not centimetre-grade absolute certification." - } -} diff --git a/results/01_previous_two_batches/final_summary.json b/results/01_previous_two_batches/final_summary.json deleted file mode 100644 index 191ee6a..0000000 --- a/results/01_previous_two_batches/final_summary.json +++ /dev/null @@ -1,440 +0,0 @@ -{ - "recommended_method": "Open3D B gated by Open3D-small_gicp cross-backend agreement", - "selection_is_X_independent": true, - "second_batch_role": "estimation (dense RTK)", - "first_batch_role": "auxiliary check only (sparse RTK)", - "consensus": { - "translation_m": [ - 1.2977596922478565, - -6.733076264476427e-05, - 0.7204978345266887 - ], - "rotation_rpy_deg_xyz": [ - -0.7851511464150316, - 1.2026608220810453, - -0.835510052785851 - ], - "estimation": { - "pairs": 39, - "translation_m": { - "rms": 0.07984780651249465, - "median": 0.05392926910429046, - "p90": 0.11822807898946641, - "p95": 0.14420733112402187, - "max": 0.2330103519747209 - }, - "rotation_deg": { - "rms": 0.961176171904301, - "median": 0.8002960897011372, - "p90": 1.422624767604584, - "p95": 1.4793113785217964, - "max": 1.7237415928660533 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.1353760421849012, - "rotation_deg": 0.5166365681634405 - }, - { - "pair_index": 1, - "translation_m": 0.11487543918383647, - "rotation_deg": 0.5717221816616095 - }, - { - "pair_index": 2, - "translation_m": 0.06210064976174764, - "rotation_deg": 0.4402983357286552 - }, - { - "pair_index": 3, - "translation_m": 0.054355548674489614, - "rotation_deg": 0.5821611725015269 - }, - { - "pair_index": 4, - "translation_m": 0.02391657882546618, - "rotation_deg": 0.32738975448002894 - }, - { - "pair_index": 5, - "translation_m": 0.07775220171630512, - "rotation_deg": 0.8706732532310371 - }, - { - "pair_index": 6, - "translation_m": 0.06265840922697155, - "rotation_deg": 0.8002960897011372 - }, - { - "pair_index": 7, - "translation_m": 0.09282561040685418, - "rotation_deg": 1.0484294819479303 - }, - { - "pair_index": 8, - "translation_m": 0.034474807960716856, - "rotation_deg": 0.40941928556312257 - }, - { - "pair_index": 9, - "translation_m": 0.13163863821198593, - "rotation_deg": 1.1065820279922887 - }, - { - "pair_index": 10, - "translation_m": 0.0018609877360485794, - "rotation_deg": 0.6081452332544832 - }, - { - "pair_index": 11, - "translation_m": 0.06488404028756532, - "rotation_deg": 0.05192051717362457 - }, - { - "pair_index": 12, - "translation_m": 0.1147488321233841, - "rotation_deg": 0.9937108406424444 - }, - { - "pair_index": 13, - "translation_m": 0.05392926910429046, - "rotation_deg": 0.9700546737541248 - }, - { - "pair_index": 14, - "translation_m": 0.02302185790244543, - "rotation_deg": 1.6149869587730064 - }, - { - "pair_index": 15, - "translation_m": 0.2330103519747209, - "rotation_deg": 0.5939965715201481 - }, - { - "pair_index": 16, - "translation_m": 0.2236889315761065, - "rotation_deg": 1.1151964340680336 - }, - { - "pair_index": 17, - "translation_m": 0.04090994021171706, - "rotation_deg": 0.7785618518380144 - }, - { - "pair_index": 18, - "translation_m": 0.054652520003134704, - "rotation_deg": 1.124375763416717 - }, - { - "pair_index": 19, - "translation_m": 0.04547500551567543, - "rotation_deg": 0.6556954445211121 - }, - { - "pair_index": 20, - "translation_m": 0.02484690940972022, - "rotation_deg": 1.7237415928660533 - }, - { - "pair_index": 21, - "translation_m": 0.056832852413462566, - "rotation_deg": 0.5831473606925555 - }, - { - "pair_index": 22, - "translation_m": 0.03998842216950218, - "rotation_deg": 1.124691549503354 - }, - { - "pair_index": 23, - "translation_m": 0.052224143195848054, - "rotation_deg": 1.1184574012171749 - }, - { - "pair_index": 24, - "translation_m": 0.06305629062353875, - "rotation_deg": 0.5252019728243343 - }, - { - "pair_index": 25, - "translation_m": 0.0552093328283033, - "rotation_deg": 0.08705258513790126 - }, - { - "pair_index": 26, - "translation_m": 0.08502281683725502, - "rotation_deg": 0.6459827373704314 - }, - { - "pair_index": 27, - "translation_m": 0.03727269737723399, - "rotation_deg": 0.7631660358041192 - }, - { - "pair_index": 28, - "translation_m": 0.04543722819346571, - "rotation_deg": 1.4218618784137362 - }, - { - "pair_index": 29, - "translation_m": 0.02559982081388642, - "rotation_deg": 1.388947601285772 - }, - { - "pair_index": 30, - "translation_m": 0.01827234061769129, - "rotation_deg": 1.206866980510853 - }, - { - "pair_index": 31, - "translation_m": 0.06863732394647468, - "rotation_deg": 1.4642363140494394 - }, - { - "pair_index": 32, - "translation_m": 0.04770629220585725, - "rotation_deg": 0.6244903967618446 - }, - { - "pair_index": 33, - "translation_m": 0.027074935362624366, - "rotation_deg": 1.3688430767407767 - }, - { - "pair_index": 34, - "translation_m": 0.03301156138156032, - "rotation_deg": 1.4256763243679755 - }, - { - "pair_index": 35, - "translation_m": 0.054240160043693975, - "rotation_deg": 0.6486412679040612 - }, - { - "pair_index": 36, - "translation_m": 0.021992835671895014, - "rotation_deg": 0.23769553016909395 - }, - { - "pair_index": 37, - "translation_m": 0.031890552923517286, - "rotation_deg": 1.0832171246083164 - }, - { - "pair_index": 38, - "translation_m": 0.025286131886091672, - "rotation_deg": 1.2215923174512224 - } - ] - }, - "bootstrap_std": [ - 0.003223574650236103, - 0.003334649335095665, - 0.0016858977028131694, - 0.0980155224808408, - 0.07461769310738842, - 0.11886090357304822 - ], - "batch1_auxiliary": { - "pairs": 22, - "translation_m": { - "rms": 0.06067269746244947, - "median": 0.042680679229823305, - "p90": 0.090942947259565, - "p95": 0.10135707648063859, - "max": 0.14643003383767556 - }, - "rotation_deg": { - "rms": 1.002984942285067, - "median": 0.707406938077333, - "p90": 1.573355332434981, - "p95": 1.7757584051966382, - "max": 1.8710372365314285 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.048343805321803004, - "rotation_deg": 0.6668376546913104, - "i": 0, - "j": 3 - }, - { - "pair_index": 1, - "translation_m": 0.0423483041362295, - "rotation_deg": 1.7859688557628564, - "i": 1, - "j": 2 - }, - { - "pair_index": 2, - "translation_m": 0.02300615185240312, - "rotation_deg": 1.8710372365314285, - "i": 2, - "j": 3 - }, - { - "pair_index": 3, - "translation_m": 0.09155252198785023, - "rotation_deg": 0.6733340854508988, - "i": 3, - "j": 4 - }, - { - "pair_index": 4, - "translation_m": 0.03158045213093479, - "rotation_deg": 0.2310116592109763, - "i": 3, - "j": 5 - }, - { - "pair_index": 5, - "translation_m": 0.07825296974670955, - "rotation_deg": 0.7403656481818025, - "i": 4, - "j": 5 - }, - { - "pair_index": 6, - "translation_m": 0.03623050776977002, - "rotation_deg": 0.29976499205053747, - "i": 5, - "j": 6 - }, - { - "pair_index": 7, - "translation_m": 0.017322045818086197, - "rotation_deg": 1.0428116209013618, - "i": 6, - "j": 7 - }, - { - "pair_index": 8, - "translation_m": 0.037890995883582496, - "rotation_deg": 0.5003524050137443, - "i": 6, - "j": 9 - }, - { - "pair_index": 9, - "translation_m": 0.055811972906268326, - "rotation_deg": 0.9711899476368479, - "i": 11, - "j": 12 - }, - { - "pair_index": 10, - "translation_m": 0.10187310566446957, - "rotation_deg": 0.48973592009907335, - "i": 17, - "j": 18 - }, - { - "pair_index": 11, - "translation_m": 0.0304808468879537, - "rotation_deg": 1.3239848803794854, - "i": 20, - "j": 21 - }, - { - "pair_index": 12, - "translation_m": 0.04462456608967399, - "rotation_deg": 0.2812977599385038, - "i": 20, - "j": 22 - }, - { - "pair_index": 13, - "translation_m": 0.03611683783839059, - "rotation_deg": 0.7096084761069892, - "i": 20, - "j": 23 - }, - { - "pair_index": 14, - "translation_m": 0.07267248449673575, - "rotation_deg": 0.6614151319251916, - "i": 21, - "j": 24 - }, - { - "pair_index": 15, - "translation_m": 0.04417889214251473, - "rotation_deg": 0.537164719319421, - "i": 22, - "j": 23 - }, - { - "pair_index": 16, - "translation_m": 0.020100630082582033, - "rotation_deg": 1.4866116021028042, - "i": 22, - "j": 24 - }, - { - "pair_index": 17, - "translation_m": 0.04301305432341711, - "rotation_deg": 0.7052054000476768, - "i": 24, - "j": 26 - }, - { - "pair_index": 18, - "translation_m": 0.0344886352240195, - "rotation_deg": 1.4977147244033493, - "i": 27, - "j": 28 - }, - { - "pair_index": 19, - "translation_m": 0.14643003383767556, - "rotation_deg": 0.527768319167481, - "i": 33, - "j": 35 - }, - { - "pair_index": 20, - "translation_m": 0.08545677470499786, - "rotation_deg": 0.7336105280022196, - "i": 34, - "j": 35 - }, - { - "pair_index": 21, - "translation_m": 0.025212589301108413, - "rotation_deg": 1.5817598444384953, - "i": 35, - "j": 36 - } - ] - } - }, - "separate_backend_results": { - "open3d_gicp": { - "translation_m": [ - 1.2978831677200011, - -0.0030997734098957433, - 0.7217892226151688 - ], - "rotation_rpy_deg_xyz": [ - -0.7572070226288585, - 1.1460424368859559, - -0.8797812288284186 - ] - }, - "small_gicp": { - "translation_m": [ - 1.2996301155160686, - -0.0035647011612625953, - 0.7218861757826791 - ], - "rotation_rpy_deg_xyz": [ - -0.7871563544979889, - 1.1414557494228486, - -0.9357571721886107 - ] - } - }, - "warning": "AX rotation RMS remains about one degree; this is not centimetre-grade absolute certification." -} diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary.npz b/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary.npz deleted file mode 100644 index 989f148..0000000 Binary files a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary.npz and /dev/null differ diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.npz b/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.npz deleted file mode 100644 index bff93f7..0000000 Binary files a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.npz and /dev/null differ diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.refinement.json b/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.refinement.json deleted file mode 100644 index e66c870..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch1_auxiliary_refined.refinement.json +++ /dev/null @@ -1,1267 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 101, - "accepted_pairs": 41, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.742135248947238, - "heldout_inlier_rmse_m": 0.1176855237061111, - "rotation_invariant_error_deg": 0.21067513987843967, - "reverse_translation_m": 0.013825313356667012, - "reverse_rotation_deg": 0.06962701621921227, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.6152139070398225, - "heldout_inlier_rmse_m": 0.12748244203393638, - "rotation_invariant_error_deg": 0.06831265614486703, - "reverse_translation_m": 0.010848197501521375, - "reverse_rotation_deg": 0.23936253539883626, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.7200942109830172, - "heldout_inlier_rmse_m": 0.11742249635115339, - "rotation_invariant_error_deg": 0.6202544008851092, - "reverse_translation_m": 0.010896220625647894, - "reverse_rotation_deg": 0.1047126090415015, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "heldout_inlier_ratio": 0.7419273778112828, - "heldout_inlier_rmse_m": 0.11333156226718596, - "rotation_invariant_error_deg": 0.5215102537074472, - "reverse_translation_m": 0.011700301190659394, - "reverse_rotation_deg": 0.07531112640817904, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.860897030953885, - "heldout_inlier_rmse_m": 0.10772639754828932, - "rotation_invariant_error_deg": 0.8383915112404274, - "reverse_translation_m": 0.0031419813068167823, - "reverse_rotation_deg": 0.07553165598013784, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 1, - "j": 4, - "heldout_inlier_ratio": 0.881875, - "heldout_inlier_rmse_m": 0.10577894988132426, - "rotation_invariant_error_deg": 1.4124868370453285, - "reverse_translation_m": 0.004385743087150129, - "reverse_rotation_deg": 0.11984963227966941, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.7933853118712274, - "heldout_inlier_rmse_m": 0.10942029884827265, - "rotation_invariant_error_deg": 0.37708448280603335, - "reverse_translation_m": 0.008219359847113026, - "reverse_rotation_deg": 0.1277049389798412, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.7129525942515864, - "heldout_inlier_rmse_m": 0.11823277244188567, - "rotation_invariant_error_deg": 1.0083488113435806, - "reverse_translation_m": 0.003926646926802803, - "reverse_rotation_deg": 0.12676782091003777, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.7434186132740082, - "heldout_inlier_rmse_m": 0.11591916677323456, - "rotation_invariant_error_deg": 0.3837872805370992, - "reverse_translation_m": 0.005762289421636631, - "reverse_rotation_deg": 0.0417195018069042, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.8393594395095709, - "heldout_inlier_rmse_m": 0.11198421236679276, - "rotation_invariant_error_deg": 0.5743898299625982, - "reverse_translation_m": 0.016040499501420776, - "reverse_rotation_deg": 0.10475252258183747, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.7942090219957748, - "heldout_inlier_rmse_m": 0.1150960059583273, - "rotation_invariant_error_deg": 0.08998045051255588, - "reverse_translation_m": 0.01716401750472473, - "reverse_rotation_deg": 0.19985666972488197, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.6534504391468005, - "heldout_inlier_rmse_m": 0.12221285442048085, - "rotation_invariant_error_deg": 0.29362645810122956, - "reverse_translation_m": 0.010758157432153631, - "reverse_rotation_deg": 0.2541461196933768, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.7519675356615839, - "heldout_inlier_rmse_m": 0.11239744207499523, - "rotation_invariant_error_deg": 0.6659953637963838, - "reverse_translation_m": 0.007054246334297592, - "reverse_rotation_deg": 0.24517862996973167, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6228429546865301, - "heldout_inlier_rmse_m": 0.12861898753238143, - "rotation_invariant_error_deg": 0.8692319587386805, - "reverse_translation_m": 0.01896562608787198, - "reverse_rotation_deg": 0.25933537698897335, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.6193556570268899, - "heldout_inlier_rmse_m": 0.13116150037214716, - "rotation_invariant_error_deg": 0.6533538541251431, - "reverse_translation_m": 0.01746189088684816, - "reverse_rotation_deg": 0.36780633600082835, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.7384387717351092, - "heldout_inlier_rmse_m": 0.11889495868628594, - "rotation_invariant_error_deg": 0.20164906424356133, - "reverse_translation_m": 0.00882639593332281, - "reverse_rotation_deg": 0.0737386250122742, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.6792642983119174, - "heldout_inlier_rmse_m": 0.11864042030155272, - "rotation_invariant_error_deg": 0.02447432627613466, - "reverse_translation_m": 0.009720083307578809, - "reverse_rotation_deg": 0.20972540690307045, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.6467507736253273, - "heldout_inlier_rmse_m": 0.12542317047495377, - "rotation_invariant_error_deg": 0.09334352738073903, - "reverse_translation_m": 0.01002585992591628, - "reverse_rotation_deg": 0.05691592874139322, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.7476148072764279, - "heldout_inlier_rmse_m": 0.11288592031143596, - "rotation_invariant_error_deg": 0.22607851892075814, - "reverse_translation_m": 0.010814191328094169, - "reverse_rotation_deg": 0.0266481566439959, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.6804804804804805, - "heldout_inlier_rmse_m": 0.11508385505331041, - "rotation_invariant_error_deg": 0.2950033546103583, - "reverse_translation_m": 0.004482804469688638, - "reverse_rotation_deg": 0.1044466289150781, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 9, - "heldout_inlier_ratio": 0.7371697154471545, - "heldout_inlier_rmse_m": 0.11682527448508172, - "rotation_invariant_error_deg": 0.3155183370205208, - "reverse_translation_m": 0.005203408768588573, - "reverse_rotation_deg": 0.04849411501759064, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.664336521952416, - "heldout_inlier_rmse_m": 0.11766047279270792, - "rotation_invariant_error_deg": 0.07473910447777143, - "reverse_translation_m": 0.0018478739597912201, - "reverse_rotation_deg": 0.09974755915747875, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 9, - "heldout_inlier_ratio": 0.6077132839890923, - "heldout_inlier_rmse_m": 0.1180552047396233, - "rotation_invariant_error_deg": 0.07573120770462083, - "reverse_translation_m": 0.010919730241803961, - "reverse_rotation_deg": 0.14576304064343415, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 10, - "heldout_inlier_ratio": 0.8481789137380191, - "heldout_inlier_rmse_m": 0.10615102438506704, - "rotation_invariant_error_deg": 1.5268647057870908, - "reverse_translation_m": 0.006788694147854834, - "reverse_rotation_deg": 0.052872203183928275, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 8, - "j": 9, - "heldout_inlier_ratio": 0.5943661971830986, - "heldout_inlier_rmse_m": 0.11920565901187036, - "rotation_invariant_error_deg": 0.08714798364420062, - "reverse_translation_m": 0.0042443197269814905, - "reverse_rotation_deg": 0.10102914613043958, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.5924719507781397, - "heldout_inlier_rmse_m": 0.12046539737502422, - "rotation_invariant_error_deg": 1.3949277293801572, - "reverse_translation_m": 0.012068925048483609, - "reverse_rotation_deg": 0.06971570917645852, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 8, - "j": 11, - "heldout_inlier_ratio": 0.6789593030194534, - "heldout_inlier_rmse_m": 0.1124672015619688, - "rotation_invariant_error_deg": 0.15938131964048807, - "reverse_translation_m": 0.006563181150688944, - "reverse_rotation_deg": 0.09301162138898374, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.6015824400204186, - "heldout_inlier_rmse_m": 0.11914584090399423, - "rotation_invariant_error_deg": 1.3836268965909966, - "reverse_translation_m": 0.023677817470035802, - "reverse_rotation_deg": 0.12091279277864625, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.5936159475145092, - "heldout_inlier_rmse_m": 0.12220038333634799, - "rotation_invariant_error_deg": 0.6232319049219228, - "reverse_translation_m": 0.010739868846460122, - "reverse_rotation_deg": 0.11267510434066752, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.6125753012048193, - "heldout_inlier_rmse_m": 0.12248054470736866, - "rotation_invariant_error_deg": 2.0697180607595165, - "reverse_translation_m": 0.006578056867618694, - "reverse_rotation_deg": 0.0648765356282168, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.5922981366459628, - "heldout_inlier_rmse_m": 0.1252332170275593, - "rotation_invariant_error_deg": 2.5203274202127974, - "reverse_translation_m": 0.0101884878590875, - "reverse_rotation_deg": 0.04905586883665525, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.5541275333662877, - "heldout_inlier_rmse_m": 0.12481360204475032, - "rotation_invariant_error_deg": 1.6668521339954658, - "reverse_translation_m": 0.031261518480906504, - "reverse_rotation_deg": 0.2822575477830575, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.4898572501878287, - "heldout_inlier_rmse_m": 0.1234709130125476, - "rotation_invariant_error_deg": 2.7180125129301445, - "reverse_translation_m": 0.002887507644989318, - "reverse_rotation_deg": 0.12861291537137956, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.8033488144707895, - "heldout_inlier_rmse_m": 0.10033649821782255, - "rotation_invariant_error_deg": 0.32790043656272516, - "reverse_translation_m": 0.0037957676909615035, - "reverse_rotation_deg": 0.030493386938618566, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.48959881129271915, - "heldout_inlier_rmse_m": 0.13002768142853224, - "rotation_invariant_error_deg": 0.8584309038051288, - "reverse_translation_m": 0.04820000634069387, - "reverse_rotation_deg": 0.21663658694591276, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.5511551155115512, - "heldout_inlier_rmse_m": 0.1363490361205856, - "rotation_invariant_error_deg": 1.9520144912043378, - "reverse_translation_m": 0.020420243910966678, - "reverse_rotation_deg": 0.3388561639372597, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.5484109386548411, - "heldout_inlier_rmse_m": 0.12959344453923985, - "rotation_invariant_error_deg": 0.2538694828651842, - "reverse_translation_m": 0.011857268436770598, - "reverse_rotation_deg": 0.07665557322523474, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.5823908549191292, - "heldout_inlier_rmse_m": 0.13141832933236727, - "rotation_invariant_error_deg": 2.4025928982804743, - "reverse_translation_m": 0.010833935971029728, - "reverse_rotation_deg": 0.22584716035991784, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 15, - "heldout_inlier_ratio": 0.5143102812922246, - "heldout_inlier_rmse_m": 0.13728792513153318, - "rotation_invariant_error_deg": 0.14115567634993909, - "reverse_translation_m": 0.012453922151317217, - "reverse_rotation_deg": 0.21281971313986298, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.6649008254281138, - "heldout_inlier_rmse_m": 0.11829356218038511, - "rotation_invariant_error_deg": 3.181788908135214, - "reverse_translation_m": 0.010710695211339957, - "reverse_rotation_deg": 0.05103080008067046, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.6433105164903546, - "heldout_inlier_rmse_m": 0.12280456147298241, - "rotation_invariant_error_deg": 2.225837821451827, - "reverse_translation_m": 0.002079348825514708, - "reverse_rotation_deg": 0.08095419399489742, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 16, - "heldout_inlier_ratio": 0.5092755076460266, - "heldout_inlier_rmse_m": 0.12767535698436475, - "rotation_invariant_error_deg": 3.537187434471443, - "reverse_translation_m": 0.01771530501608281, - "reverse_rotation_deg": 0.1987385247368959, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 15, - "heldout_inlier_ratio": 0.7934889434889435, - "heldout_inlier_rmse_m": 0.10996554201681306, - "rotation_invariant_error_deg": 2.3643588580573045, - "reverse_translation_m": 0.010537581931095797, - "reverse_rotation_deg": 0.18886023198851049, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.5124335024124707, - "heldout_inlier_rmse_m": 0.1271130929550258, - "rotation_invariant_error_deg": 2.6108564911858636, - "reverse_translation_m": 0.0367675981786339, - "reverse_rotation_deg": 0.17067950171934768, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.5997034840622684, - "heldout_inlier_rmse_m": 0.12123178848040567, - "rotation_invariant_error_deg": 1.8286783963418458, - "reverse_translation_m": 0.007039639082169618, - "reverse_rotation_deg": 0.1420706023439064, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.4525684289463817, - "heldout_inlier_rmse_m": 0.1310762605599437, - "rotation_invariant_error_deg": 1.1250697296255026, - "reverse_translation_m": 0.03028489261617412, - "reverse_rotation_deg": 0.2306307424740811, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.5419370943584623, - "heldout_inlier_rmse_m": 0.12926666329467473, - "rotation_invariant_error_deg": 0.29833629421023744, - "reverse_translation_m": 0.016749087599431237, - "reverse_rotation_deg": 0.21516518274709787, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.725455688246386, - "heldout_inlier_rmse_m": 0.11626130134637655, - "rotation_invariant_error_deg": 0.5412835907835287, - "reverse_translation_m": 0.008173066808338859, - "reverse_rotation_deg": 0.1459219364983215, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "heldout_inlier_ratio": 0.7509598157153826, - "heldout_inlier_rmse_m": 0.11215936550371307, - "rotation_invariant_error_deg": 0.6137201728110284, - "reverse_translation_m": 0.01007065253007885, - "reverse_rotation_deg": 0.024451533638690782, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "heldout_inlier_ratio": 0.61725, - "heldout_inlier_rmse_m": 0.11278472852394253, - "rotation_invariant_error_deg": 0.7030883833687938, - "reverse_translation_m": 0.013911959588582991, - "reverse_rotation_deg": 0.09838261866068182, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.7936102236421725, - "heldout_inlier_rmse_m": 0.10947670477666799, - "rotation_invariant_error_deg": 0.12090790046002553, - "reverse_translation_m": 0.004348617987976676, - "reverse_rotation_deg": 0.08578297576648478, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.6638372238172513, - "heldout_inlier_rmse_m": 0.11457050422944211, - "rotation_invariant_error_deg": 0.20497832393222382, - "reverse_translation_m": 0.011384309901198326, - "reverse_rotation_deg": 0.08601325248059774, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 20, - "heldout_inlier_ratio": 0.6755903523172118, - "heldout_inlier_rmse_m": 0.11461754659819628, - "rotation_invariant_error_deg": 0.2602481130734873, - "reverse_translation_m": 0.003070224389531284, - "reverse_rotation_deg": 0.041777705584758074, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.7679796696315121, - "heldout_inlier_rmse_m": 0.10951225500902462, - "rotation_invariant_error_deg": 0.1404870179521538, - "reverse_translation_m": 0.0016757410207260358, - "reverse_rotation_deg": 0.05240557176555545, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "heldout_inlier_ratio": 0.7909488300334276, - "heldout_inlier_rmse_m": 0.11336174254244849, - "rotation_invariant_error_deg": 0.1431820227633267, - "reverse_translation_m": 0.0011490974177271606, - "reverse_rotation_deg": 0.05798276029492007, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "heldout_inlier_ratio": 0.7659654868371332, - "heldout_inlier_rmse_m": 0.11623488568922577, - "rotation_invariant_error_deg": 0.539131001940433, - "reverse_translation_m": 0.0007397588392132655, - "reverse_rotation_deg": 0.049540488476333674, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 20, - "heldout_inlier_ratio": 0.7140883977900553, - "heldout_inlier_rmse_m": 0.1080327967474786, - "rotation_invariant_error_deg": 0.040991721374453505, - "reverse_translation_m": 0.008102122424322853, - "reverse_rotation_deg": 0.0646114560547033, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "heldout_inlier_ratio": 0.6584615384615384, - "heldout_inlier_rmse_m": 0.10963878686899117, - "rotation_invariant_error_deg": 0.4169226022129493, - "reverse_translation_m": 0.012913229197399395, - "reverse_rotation_deg": 0.08080164801156113, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 22, - "heldout_inlier_ratio": 0.6261591020009761, - "heldout_inlier_rmse_m": 0.11484815169172223, - "rotation_invariant_error_deg": 0.06725841120285736, - "reverse_translation_m": 0.008079663853152794, - "reverse_rotation_deg": 0.06664730348633674, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.8130212871903398, - "heldout_inlier_rmse_m": 0.10717601941116739, - "rotation_invariant_error_deg": 0.40826612650997873, - "reverse_translation_m": 0.003986207075465725, - "reverse_rotation_deg": 0.014468856174509968, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.709279368213228, - "heldout_inlier_rmse_m": 0.11654592484503022, - "rotation_invariant_error_deg": 0.022600434692449767, - "reverse_translation_m": 0.004732316748497569, - "reverse_rotation_deg": 0.04653511032479733, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.7151155604993202, - "heldout_inlier_rmse_m": 0.11440209684434971, - "rotation_invariant_error_deg": 0.4686770519132466, - "reverse_translation_m": 0.013864191008669256, - "reverse_rotation_deg": 0.04741774806449891, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7434966727162734, - "heldout_inlier_rmse_m": 0.11011755646689264, - "rotation_invariant_error_deg": 0.33595060418958766, - "reverse_translation_m": 0.0010075959724342985, - "reverse_rotation_deg": 0.03301381213076696, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.7529083858458555, - "heldout_inlier_rmse_m": 0.11149633235838309, - "rotation_invariant_error_deg": 0.8365460142295191, - "reverse_translation_m": 0.001989351505445817, - "reverse_rotation_deg": 0.010666288445208057, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.7106949236076885, - "heldout_inlier_rmse_m": 0.11526418670282225, - "rotation_invariant_error_deg": 0.5731879364234658, - "reverse_translation_m": 0.0033123302523526757, - "reverse_rotation_deg": 0.010450448797924646, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.8800913132284032, - "heldout_inlier_rmse_m": 0.0910569893232571, - "rotation_invariant_error_deg": 0.4865652618226086, - "reverse_translation_m": 0.0032245216994413483, - "reverse_rotation_deg": 0.016462830433921317, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.746915842188836, - "heldout_inlier_rmse_m": 0.11145740682737049, - "rotation_invariant_error_deg": 0.18016284061197751, - "reverse_translation_m": 0.01259476909551429, - "reverse_rotation_deg": 0.07575320422516746, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.6202953787517865, - "heldout_inlier_rmse_m": 0.10996904036547328, - "rotation_invariant_error_deg": 0.14468445614926395, - "reverse_translation_m": 0.01971125516503169, - "reverse_rotation_deg": 0.10319789629151777, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.7859065329092244, - "heldout_inlier_rmse_m": 0.11467536863831725, - "rotation_invariant_error_deg": 0.31204204397768365, - "reverse_translation_m": 0.011606021246419816, - "reverse_rotation_deg": 0.08140725284903579, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.6364070141953955, - "heldout_inlier_rmse_m": 0.11293944470788622, - "rotation_invariant_error_deg": 0.3499617911099051, - "reverse_translation_m": 0.02314438992859391, - "reverse_rotation_deg": 0.07068788850704667, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6150898203592814, - "heldout_inlier_rmse_m": 0.11134349524292353, - "rotation_invariant_error_deg": 0.015605819915208485, - "reverse_translation_m": 0.039322949699257106, - "reverse_rotation_deg": 0.11562859307450143, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.7858615254031769, - "heldout_inlier_rmse_m": 0.11149776506996652, - "rotation_invariant_error_deg": 0.059243878773351355, - "reverse_translation_m": 0.011240124367435099, - "reverse_rotation_deg": 0.1049569848741807, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.7456781105429754, - "heldout_inlier_rmse_m": 0.10341842736085993, - "rotation_invariant_error_deg": 0.3004880656520754, - "reverse_translation_m": 0.01395883182919579, - "reverse_rotation_deg": 0.08780591339848752, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.621380846325167, - "heldout_inlier_rmse_m": 0.10953325191126222, - "rotation_invariant_error_deg": 0.019843100622125576, - "reverse_translation_m": 0.016637332395867215, - "reverse_rotation_deg": 0.10353943868518889, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.8347382167873679, - "heldout_inlier_rmse_m": 0.10115747661888057, - "rotation_invariant_error_deg": 0.3658877209035154, - "reverse_translation_m": 0.01268722454395532, - "reverse_rotation_deg": 0.041403863092781025, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.624412013026173, - "heldout_inlier_rmse_m": 0.11277808045896366, - "rotation_invariant_error_deg": 0.06613702433831747, - "reverse_translation_m": 0.025589655197266314, - "reverse_rotation_deg": 0.15422514597254583, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 28, - "heldout_inlier_ratio": 0.5869307400379506, - "heldout_inlier_rmse_m": 0.11770827672499123, - "rotation_invariant_error_deg": 0.05787468544141916, - "reverse_translation_m": 0.022027669812843296, - "reverse_rotation_deg": 0.2897817423195282, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.6580285783482683, - "heldout_inlier_rmse_m": 0.1098010629341849, - "rotation_invariant_error_deg": 0.31277028986205835, - "reverse_translation_m": 0.0028795138573569803, - "reverse_rotation_deg": 0.007524827744647535, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.6673413501607334, - "heldout_inlier_rmse_m": 0.11114983317987888, - "rotation_invariant_error_deg": 0.43354316548742133, - "reverse_translation_m": 0.008151782060846088, - "reverse_rotation_deg": 0.22733511766651973, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.795572759162937, - "heldout_inlier_rmse_m": 0.10258057277674534, - "rotation_invariant_error_deg": 0.1749280068799166, - "reverse_translation_m": 0.0021193681800924964, - "reverse_rotation_deg": 0.11642323746608753, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7440454600411075, - "heldout_inlier_rmse_m": 0.10506613395932038, - "rotation_invariant_error_deg": 0.052860729474531354, - "reverse_translation_m": 0.010617830050775887, - "reverse_rotation_deg": 0.010252586949293494, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.829172610556348, - "heldout_inlier_rmse_m": 0.101007907265047, - "rotation_invariant_error_deg": 0.21987544891261024, - "reverse_translation_m": 0.002050657211153992, - "reverse_rotation_deg": 0.060432422726630436, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "heldout_inlier_ratio": 0.5045164398410213, - "heldout_inlier_rmse_m": 0.12642928247376978, - "rotation_invariant_error_deg": 0.2644422542965117, - "reverse_translation_m": 0.020394024193417442, - "reverse_rotation_deg": 0.4096021180283358, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 29, - "j": 30, - "heldout_inlier_ratio": 0.5217133364973896, - "heldout_inlier_rmse_m": 0.12674065647229513, - "rotation_invariant_error_deg": 0.3348446060592494, - "reverse_translation_m": 0.029506475723043876, - "reverse_rotation_deg": 0.11389243918851435, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.8362783988460152, - "heldout_inlier_rmse_m": 0.09839553390448733, - "rotation_invariant_error_deg": 0.3174012575815368, - "reverse_translation_m": 0.00292801654357991, - "reverse_rotation_deg": 0.07029435398214784, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.8588193030774758, - "heldout_inlier_rmse_m": 0.09922846236206209, - "rotation_invariant_error_deg": 2.670541361601366, - "reverse_translation_m": 0.007868521232743847, - "reverse_rotation_deg": 0.0646663588791515, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 30, - "j": 33, - "heldout_inlier_ratio": 0.7985030295829868, - "heldout_inlier_rmse_m": 0.09950089003213429, - "rotation_invariant_error_deg": 0.08837368655548516, - "reverse_translation_m": 0.002818384349407474, - "reverse_rotation_deg": 0.04751878128625789, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.8562575941676792, - "heldout_inlier_rmse_m": 0.09641015722415121, - "rotation_invariant_error_deg": 2.992321949061811, - "reverse_translation_m": 0.00743603397476557, - "reverse_rotation_deg": 0.05749362415769439, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 31, - "j": 33, - "heldout_inlier_ratio": 0.7594021215043394, - "heldout_inlier_rmse_m": 0.09971190839470828, - "rotation_invariant_error_deg": 0.40934993154145616, - "reverse_translation_m": 0.008658288176145966, - "reverse_rotation_deg": 0.04699249624411687, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 33, - "heldout_inlier_ratio": 0.859390009606148, - "heldout_inlier_rmse_m": 0.09596734045987164, - "rotation_invariant_error_deg": 2.576805409090362, - "reverse_translation_m": 0.007599187780672587, - "reverse_rotation_deg": 0.08086834965344242, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 32, - "j": 34, - "heldout_inlier_ratio": 0.8306916426512968, - "heldout_inlier_rmse_m": 0.09663160733562838, - "rotation_invariant_error_deg": 2.5077877425105584, - "reverse_translation_m": 0.008708468398558678, - "reverse_rotation_deg": 0.031578495955716095, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 32, - "j": 35, - "heldout_inlier_ratio": 0.8055028462998103, - "heldout_inlier_rmse_m": 0.09329597448562056, - "rotation_invariant_error_deg": 3.1088028295720562, - "reverse_translation_m": 0.002684669665422271, - "reverse_rotation_deg": 0.0241000049832631, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 33, - "j": 34, - "heldout_inlier_ratio": 0.8550154872527996, - "heldout_inlier_rmse_m": 0.09764473733600805, - "rotation_invariant_error_deg": 0.051334107043899735, - "reverse_translation_m": 0.005560284067502743, - "reverse_rotation_deg": 0.07666131775182662, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "heldout_inlier_ratio": 0.8344316309719935, - "heldout_inlier_rmse_m": 0.08989959394950665, - "rotation_invariant_error_deg": 0.5184221255504866, - "reverse_translation_m": 0.0013737288250339052, - "reverse_rotation_deg": 0.028590963377823297, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "heldout_inlier_ratio": 0.7655961609449982, - "heldout_inlier_rmse_m": 0.10046425727734096, - "rotation_invariant_error_deg": 1.0485420617240777, - "reverse_translation_m": 0.012544124903927084, - "reverse_rotation_deg": 0.05831564134554671, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 34, - "j": 35, - "heldout_inlier_ratio": 0.8692633560837845, - "heldout_inlier_rmse_m": 0.08711586696140278, - "rotation_invariant_error_deg": 0.5631194094821339, - "reverse_translation_m": 0.006834102546614079, - "reverse_rotation_deg": 0.04740606842462777, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "heldout_inlier_ratio": 0.771256306140027, - "heldout_inlier_rmse_m": 0.09836949441930562, - "rotation_invariant_error_deg": 1.1019145808888737, - "reverse_translation_m": 0.004832468349243269, - "reverse_rotation_deg": 0.046439990812924645, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 34, - "j": 37, - "heldout_inlier_ratio": 0.722881252293017, - "heldout_inlier_rmse_m": 0.10001696647063055, - "rotation_invariant_error_deg": 0.5815554673797863, - "reverse_translation_m": 0.0035748664819913244, - "reverse_rotation_deg": 0.09211471145637762, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "heldout_inlier_ratio": 0.7697728101081278, - "heldout_inlier_rmse_m": 0.09462474495647087, - "rotation_invariant_error_deg": 0.510111948490767, - "reverse_translation_m": 0.004833519542267701, - "reverse_rotation_deg": 0.07989067847153554, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "heldout_inlier_ratio": 0.7351769110010868, - "heldout_inlier_rmse_m": 0.09626480689856566, - "rotation_invariant_error_deg": 1.1883438863833788, - "reverse_translation_m": 0.00826951342075784, - "reverse_rotation_deg": 0.05772015666601106, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 36, - "j": 37, - "heldout_inlier_ratio": 0.8790139064475347, - "heldout_inlier_rmse_m": 0.08686306972783016, - "rotation_invariant_error_deg": 1.7415833773787384, - "reverse_translation_m": 0.0018743847744752261, - "reverse_rotation_deg": 0.0426177033120738, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - } - ] -} diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.csv b/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.csv deleted file mode 100644 index feb7573..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.csv +++ /dev/null @@ -1,109 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,4.069460063439237,24.612641616688823,0.742135248947238,0.1176855237061111,6,4.407651482488117,0.013825313356667012,0.06962701621921227,1.0,True, -0,2,8.883155687691525,14.186041609026283,0.6152139070398225,0.12748244203393638,6,7.377377816318336,0.010848197501521375,0.23936253539883626,1.0,True, -0,3,5.800196618465403,50.885974946353855,0.7200942109830172,0.11742249635115339,6,5.031984522656203,0.010896220625647894,0.1047126090415015,1.0,True, -1,2,4.892046307546544,10.426600007662538,0.7419273778112828,0.11333156226718596,6,4.459403177706152,0.011700301190659394,0.07531112640817904,1.0,True, -1,3,1.7315947839093804,26.273333329665036,0.860897030953885,0.10772639754828932,6,3.19377614050938,0.0031419813068167823,0.07553165598013784,1.0,True, -1,4,1.6946255625760025,60.40345832959281,0.881875,0.10577894988132426,6,3.092963722704653,0.004385743087150129,0.11984963227966941,1.0,True, -2,3,3.2805755806518446,36.69993333732758,0.7933853118712274,0.10942029884827265,6,3.7004807304428255,0.008219359847113026,0.1277049389798412,1.0,True, -2,4,4.866335020594746,70.83005833725535,0.7129525942515864,0.11823277244188567,6,3.5207832348575936,0.003926646926802803,0.12676782091003777,1.0,True, -2,5,1.8274406190287722,30.448549979291712,0.7434186132740082,0.11591916677323456,6,3.2245913426430066,0.005762289421636631,0.0417195018069042,1.0,True, -3,4,1.75881263274858,34.13012499992777,0.8393594395095709,0.11198421236679276,6,2.9955796261301395,0.016040499501420776,0.10475252258183747,1.0,True, -3,5,2.1020200425132134,67.14848331661929,0.7942090219957748,0.1150960059583273,6,3.466731955810642,0.01716401750472473,0.19985666972488197,1.0,True, -3,6,5.791805311102367,61.163322289150074,0.6534504391468005,0.12221285442048085,6,4.065547866736895,0.010758157432153631,0.2541461196933768,1.0,True, -4,5,3.30592832159088,101.27860831654709,0.7519675356615839,0.11239744207499523,6,3.538427973689991,0.007054246334297592,0.24517862996973167,1.0,True, -4,6,6.453995240105232,95.29344728907782,0.6228429546865301,0.12861898753238143,6,5.239918976750594,0.01896562608787198,0.25933537698897335,1.0,True, -4,7,9.537609568572432,26.32130681988008,0.6193556570268899,0.13116150037214716,6,6.94052030016787,0.01746189088684816,0.36780633600082835,1.0,True, -5,6,3.7769167422851373,5.985161027469212,0.7384387717351092,0.11889495868628594,6,3.6057257786167156,0.00882639593332281,0.0737386250122742,1.0,True, -5,7,6.565348405821576,74.95730149666699,0.6792642983119174,0.11864042030155272,6,4.820407924638239,0.009720083307578809,0.20972540690307045,1.0,True, -5,8,6.3343271669452825,107.99940292217995,0.6467507736253273,0.12542317047495377,6,3.0799731272083655,0.01002585992591628,0.05691592874139322,1.0,True, -6,7,3.1558607172566147,68.97214046919777,0.7476148072764279,0.11288592031143596,6,3.5859463118826977,0.010814191328094169,0.0266481566439959,1.0,True, -6,8,3.3979014114419868,102.01424189471071,0.6804804804804805,0.11508385505331041,6,2.2706877166387276,0.004482804469688638,0.1044466289150781,1.0,True, -6,9,0.28270347875173524,124.11602215258995,0.7371697154471545,0.11682527448508172,6,2.8975705145594723,0.005203408768588573,0.04849411501759064,1.0,True, -7,8,4.78580085090425,33.04210142551296,0.664336521952416,0.11766047279270792,6,2.929070995599858,0.0018478739597912201,0.09974755915747875,1.0,True, -7,9,2.876695741106431,166.91183737821345,0.6077132839890923,0.1180552047396233,6,3.7184930305903685,0.010919730241803961,0.14576304064343415,1.0,True, -7,10,3.5227760858025783,151.5297683494061,0.8481789137380191,0.10615102438506704,6,2.8662462784517695,0.006788694147854834,0.052872203183928275,1.0,True, -8,9,3.469611483011297,133.86973595269956,0.5943661971830986,0.11920565901187036,6,3.7883774947006965,0.0042443197269814905,0.10102914613043958,1.0,True, -8,10,8.226583602288494,175.42813022508852,0.5924719507781397,0.12046539737502422,6,6.6212639471399966,0.012068925048483609,0.06971570917645852,1.0,True, -8,11,1.865267488778983,173.7180803410843,0.6789593030194534,0.1124672015619688,6,2.333957745729889,0.006563181150688944,0.09301162138898374,1.0,True, -9,10,5.488028285806731,41.558394272381754,0.6015824400204186,0.11914584090399423,6,5.490861355062907,0.023677817470035802,0.12091279277864625,1.0,True, -9,11,4.718056434111957,39.84834438838189,0.5936159475145092,0.12220038333634799,6,2.975477564952316,0.010739868846460122,0.11267510434066752,1.0,True, -9,12,4.0664516687652705,11.300244475855449,0.6125753012048193,0.12248054470736866,6,2.850813791288553,0.006578056867618694,0.0648765356282168,1.0,True, -10,11,8.48963239412477,1.7100498839998592,0.5922981366459628,0.1252332170275593,6,3.561970732702301,0.0101884878590875,0.04905586883665525,1.0,True, -10,12,7.8510898708654135,30.258149796526293,0.5541275333662877,0.12481360204475032,6,3.7517795436266956,0.031261518480906504,0.2822575477830575,1.0,True, -10,13,7.303425556850936,93.89697482620899,0.4898572501878287,0.1234709130125476,6,5.011926866876523,0.002887507644989318,0.12861291537137956,1.0,True, -11,12,0.684356309096518,28.54809991252644,0.8033488144707895,0.10033649821782255,6,2.8495161791494152,0.0037957676909615035,0.030493386938618566,1.0,True, -11,13,4.983180422136547,92.18692494220912,0.48959881129271915,0.13002768142853224,6,7.500744983348576,0.04820000634069387,0.21663658694591276,1.0,True, -11,14,7.513058208926106,116.17598776756182,0.5511551155115512,0.1363490361205856,6,8.69179713026475,0.020420243910966678,0.3388561639372597,1.0,True, -12,13,4.470221622128888,63.638825029682685,0.5484109386548411,0.12959344453923985,6,6.303133528073185,0.011857268436770598,0.07665557322523474,1.0,True, -12,14,7.042432348069883,87.62788785503537,0.5823908549191292,0.13141832933236727,6,7.376965777627224,0.010833935971029728,0.22584716035991784,1.0,True, -12,15,9.425648786798952,64.11974003309916,0.5143102812922246,0.13728792513153318,6,10.6657111200586,0.012453922151317217,0.21281971313986298,1.0,True, -13,14,2.6059162757855927,23.989062825352686,0.6649008254281138,0.11829356218038511,6,4.46953470312236,0.010710695211339957,0.05103080008067046,1.0,True, -13,15,4.985522367267706,0.4809150034164723,0.6433105164903546,0.12280456147298241,6,5.48212715248282,0.002079348825514708,0.08095419399489742,1.0,True, -13,16,5.330126890587504,0.570225046299944,0.5092755076460266,0.12767535698436475,6,5.1227851245513,0.01771530501608281,0.1987385247368959,1.0,True, -14,15,2.3845573265941185,23.508147821936216,0.7934889434889435,0.10996554201681306,6,3.5978390564938083,0.010537581931095797,0.18886023198851049,1.0,True, -14,16,7.871327660405588,24.55928787165262,0.5124335024124707,0.1271130929550258,6,6.773046277884419,0.0367675981786339,0.17067950171934768,1.0,True, -14,17,6.334147330965719,0.13339551798522414,0.5997034840622684,0.12123178848040567,6,5.0521521307734485,0.007039639082169618,0.1420706023439064,1.0,True, -15,16,10.188241681839806,1.051140049716416,0.4525684289463817,0.1310762605599437,6,10.161233588287896,0.03028489261617412,0.2306307424740811,1.0,True, -15,17,8.639041695194567,23.641543339921444,0.5419370943584623,0.12926666329467473,6,7.1208904116826295,0.016749087599431237,0.21516518274709787,1.0,True, -15,18,9.620687246763701,76.25281000098852,0.5239486723415068,0.13468232645821807,6,7.765728655204814,0.015824236097669597,0.5418501890608881,1.0,False,forward_reverse_rotation -16,17,1.5531467972267479,24.69268338963786,0.725455688246386,0.11626130134637655,6,2.5539312507809044,0.008173066808338859,0.1459219364983215,1.0,True, -16,18,0.5677742310084086,77.30395005070493,0.7509598157153826,0.11215936550371307,6,2.72958456426664,0.01007065253007885,0.024451533638690782,1.0,True, -16,19,2.9811390265794215,109.91770005034847,0.61725,0.11278472852394253,6,3.8445921585562353,0.013911959588582991,0.09838261866068182,1.0,True, -17,18,0.98603936348044,52.61126666106708,0.7936102236421725,0.10947670477666799,6,2.9613430589728713,0.004348617987976676,0.08578297576648478,1.0,True, -17,19,3.326868398717413,85.22501666071064,0.6638372238172513,0.11457050422944211,6,4.039052271877423,0.011384309901198326,0.08601325248059774,1.0,True, -17,20,1.702964560097507,146.95247656520317,0.6755903523172118,0.11461754659819628,6,2.9771145257220444,0.003070224389531284,0.041777705584758074,1.0,True, -18,19,3.0423123591285863,32.61374999964355,0.7679796696315121,0.10951225500902462,6,3.162387301290471,0.0016757410207260358,0.05240557176555545,1.0,True, -18,20,1.0853574230860805,94.34120990413592,0.7909488300334276,0.11336174254244849,6,2.472783746978993,0.0011490974177271606,0.05798276029492007,1.0,True, -18,21,0.7190584934612743,134.43032499953063,0.7659654868371332,0.11623488568922577,6,2.3334272634442037,0.0007397588392132655,0.049540488476333674,1.0,True, -19,20,1.9962827272376449,61.72745990449234,0.7140883977900553,0.1080327967474786,6,2.8867642059111027,0.008102122424322853,0.0646114560547033,1.0,True, -19,21,3.133843614009462,101.81657499988698,0.6584615384615384,0.10963878686899117,6,2.8691912248684632,0.012913229197399395,0.08080164801156113,1.0,True, -19,22,3.558853688535236,131.87013333415302,0.6261591020009761,0.11484815169172223,6,3.1506020281084415,0.008079663853152794,0.06664730348633674,1.0,True, -20,21,1.4312693216245356,40.08911509539463,0.8130212871903398,0.10717601941116739,6,2.598682401671686,0.003986207075465725,0.014468856174509968,1.0,True, -20,22,2.8745434122269677,70.1426734296607,0.709279368213228,0.11654592484503022,6,3.3550200552976293,0.004732316748497569,0.04653511032479733,1.0,True, -20,23,2.368927629183393,88.7954400941961,0.7151155604993202,0.11440209684434971,6,3.0862044513861178,0.013864191008669256,0.04741774806449891,1.0,True, -21,22,1.9888588003695142,30.053558334266054,0.7434966727162734,0.11011755646689264,6,3.014221192692681,0.0010075959724342985,0.03301381213076696,1.0,True, -21,23,1.9477165743251885,48.70632499880147,0.7529083858458555,0.11149633235838309,6,3.077926485095861,0.001989351505445817,0.010666288445208057,1.0,True, -21,24,3.76075382790461,86.89547500633407,0.7106949236076885,0.11526418670282225,6,3.884216729530811,0.0033123302523526757,0.010450448797924646,1.0,True, -22,23,0.8778876913955667,18.652766664535406,0.8800913132284032,0.0910569893232571,6,2.4100478670835583,0.0032245216994413483,0.016462830433921317,1.0,True, -22,24,2.2510479983846268,56.84191667206801,0.746915842188836,0.11145740682737049,6,2.851886485949151,0.01259476909551429,0.07575320422516746,1.0,True, -22,25,3.452614527841686,105.36038662410485,0.6202953787517865,0.10996904036547328,6,3.4469213215286616,0.01971125516503169,0.10319789629151777,1.0,True, -23,24,1.8212773036309853,38.18915000753262,0.7859065329092244,0.11467536863831725,6,2.8422525641977647,0.011606021246419816,0.08140725284903579,1.0,True, -23,25,2.999856552735995,86.70761995956946,0.6364070141953955,0.11293944470788622,6,3.2389862166172447,0.02314438992859391,0.07068788850704667,1.0,True, -23,26,1.7088514993141615,157.34900000166795,0.6150898203592814,0.11134349524292353,6,3.3995614886239296,0.039322949699257106,0.11562859307450143,1.0,True, -24,25,1.2059352225587747,48.51846995203683,0.7858615254031769,0.11149776506996652,6,2.476851261276463,0.011240124367435099,0.1049569848741807,1.0,True, -24,26,1.1958827550030364,119.15984999413537,0.7456781105429754,0.10341842736085993,6,2.5300194557440525,0.01395883182919579,0.08780591339848752,1.0,True, -24,27,3.786115539231191,149.59794999698258,0.621380846325167,0.10953325191126222,6,3.7363642522268807,0.016637332395867215,0.10353943868518889,1.0,True, -25,26,1.8270495459501794,70.64138004209858,0.8347382167873679,0.10115747661888057,6,3.0333095788198037,0.01268722454395532,0.041403863092781025,1.0,True, -25,27,4.741885618180033,101.07948004494568,0.624412013026173,0.11277808045896366,6,3.9078457957611743,0.025589655197266314,0.15422514597254583,1.0,True, -25,28,3.8640843382258447,141.59343004213218,0.5869307400379506,0.11770827672499123,6,4.799123781945888,0.022027669812843296,0.2897817423195282,1.0,True, -26,27,2.939444415707082,30.43810000284707,0.6580285783482683,0.1098010629341849,6,3.5110471043097586,0.0028795138573569803,0.007524827744647535,1.0,True, -26,28,2.285770454773634,70.95205000003368,0.6673413501607334,0.11114983317987888,6,3.8873517833668108,0.008151782060846088,0.22733511766651973,1.0,True, -26,29,3.6568094249627374,131.92299999999997,0.567654409139593,0.1129321723600836,6,3.929185583738771,0.018525590401292088,0.6411617076853331,1.0,False,forward_reverse_rotation -27,28,2.3764785758716087,40.513949997186636,0.795572759162937,0.10258057277674534,6,3.138921602248635,0.0021193681800924964,0.11642323746608753,1.0,True, -27,29,4.061689152213973,101.48489999715295,0.7440454600411075,0.10506613395932038,6,3.1227510205159508,0.010617830050775887,0.010252586949293494,1.0,True, -27,30,5.033742765789926,178.61309998505533,0.5825184112036702,0.11453665822491028,6,7.650962341345717,2.5431128502617377,2.5742599673919253,1.0,False,forward_reverse_translation;forward_reverse_rotation -28,29,1.7860052935263149,60.970949999966315,0.829172610556348,0.101007907265047,6,3.8068503338763042,0.002050657211153992,0.060432422726630436,1.0,True, -28,30,7.378510482049102,138.09914998778677,0.5397673314339981,0.12193285407050827,6,9.554349687793176,2.3478431587463846,1.5786016001583607,1.0,False,forward_reverse_translation;forward_reverse_rotation -28,31,8.396001985859645,161.15751666826222,0.5045164398410213,0.12642928247376978,6,9.31764609998303,0.020394024193417442,0.4096021180283358,1.0,True, -29,30,8.925911734961222,77.12819998782052,0.5217133364973896,0.12674065647229513,6,8.522188842167411,0.029506475723043876,0.11389243918851435,1.0,True, -29,31,9.936139535050964,100.18656666829587,0.49500421331407246,0.12930714939449198,6,8.914982386428042,0.09268316078142827,0.5769686714189283,1.0,False,forward_reverse_translation;forward_reverse_rotation -29,32,9.719184595429152,159.1482027457047,0.4949034656433625,0.12826034683961704,6,9.48481031343127,0.046228293643484374,0.3497292020413176,0.0,False,multistart_instability -30,31,1.0176267260390144,23.058366680475352,0.8362783988460152,0.09839553390448733,6,3.4866604582833345,0.00292801654357991,0.07029435398214784,1.0,True, -30,32,0.8427696971904044,82.02000275788396,0.8588193030774758,0.09922846236206209,6,3.665055653691297,0.007868521232743847,0.0646663588791515,1.0,True, -30,33,1.1320092061720382,147.1799498371321,0.7985030295829868,0.09950089003213429,6,4.012416511656465,0.002818384349407474,0.04751878128625789,1.0,True, -31,32,0.2771314063233405,58.9616360774086,0.8562575941676792,0.09641015722415121,6,3.1475922536183365,0.00743603397476557,0.05749362415769439,1.0,True, -31,33,0.5409306841643147,124.12158315665668,0.7594021215043394,0.09971190839470828,6,3.924941555652805,0.008658288176145966,0.04699249624411687,1.0,True, -31,34,0.9901318542574941,155.5976733552555,0.7827868852459017,0.09387821156002771,6,3.677769944550314,0.001760438169327793,0.07141137968742438,0.0,False,multistart_instability -32,33,0.38765596924480794,65.15994707924807,0.859390009606148,0.09596734045987164,6,3.3457711754162425,0.007599187780672587,0.08086834965344242,1.0,True, -32,34,1.0327853226589305,96.63603727784675,0.8306916426512968,0.09663160733562838,6,3.561692133355112,0.008708468398558678,0.031578495955716095,1.0,True, -32,35,1.1947451269258382,131.6892972449946,0.8055028462998103,0.09329597448562056,6,3.202004817860687,0.002684669665422271,0.0241000049832631,1.0,True, -33,34,0.7453275493729801,31.47609019859864,0.8550154872527996,0.09764473733600805,6,3.153108280248987,0.005560284067502743,0.07666131775182662,1.0,True, -33,35,1.0924186931915323,66.52935016574651,0.8344316309719935,0.08989959394950665,6,3.014281766333208,0.0013737288250339052,0.028590963377823297,1.0,True, -33,36,3.335020341384374,123.21987515531416,0.7655961609449982,0.10046425727734096,6,3.222688396070449,0.012544124903927084,0.05831564134554671,1.0,True, -34,35,0.6186130964444055,35.05325996714787,0.8692633560837845,0.08711586696140278,6,2.9228018947680083,0.006834102546614079,0.04740606842462777,1.0,True, -34,36,3.114273556969299,91.74378495671547,0.771256306140027,0.09836949441930562,6,3.7389528980898077,0.004832468349243269,0.046439990812924645,1.0,True, -34,37,2.8155528331227235,126.08390993626574,0.722881252293017,0.10001696647063055,6,3.8298681993003196,0.0035748664819913244,0.09211471145637762,1.0,True, -35,36,2.4989423629184655,56.69052498956759,0.7697728101081278,0.09462474495647087,6,3.9667933176330195,0.004833519542267701,0.07989067847153554,1.0,True, -35,37,2.2182956249874577,91.03064996911786,0.7351769110010868,0.09626480689856566,6,3.604883740945235,0.00826951342075784,0.05772015666601106,1.0,True, -36,37,0.5129211474320938,34.34012497955026,0.8790139064475347,0.08686306972783016,6,2.86419132160936,0.0018743847744752261,0.0426177033120738,1.0,True, diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.json b/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.json deleted file mode 100644 index 9658f02..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch1_quality.json +++ /dev/null @@ -1,13475 +0,0 @@ -{ - "schema_version": 2, - "backend": "open3d", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 38, - "candidate_pairs": 108, - "accepted_pairs": 101, - "parameters": { - "command": "pairs", - "backend": "open3d", - "frames": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_20260717\\prepared\\frames_all", - "body": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_20260717\\prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch1_auxiliary.npz", - "quality_json": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch1_quality.json", - "quality_csv": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch1_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 25, - "min_gap": 1, - "max_gap": 3, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 40, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 1, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 92, - "translation_rms_m": 0.019568612537964526, - "translation_p95_m": 0.03480485827703029, - "rotation_rms_deg": 0.23239902579058, - "rotation_p95_deg": 0.39594096816947427 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254210.7437553, - "frame_counter_i": 290, - "frame_counter_j": 1629, - "rtk_translation_m": 4.069460063439237, - "rtk_rotation_deg": 24.612641616688823, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9076900225850482, - -0.4194984168696996, - -0.010949938053311913, - 3.8651680739635563 - ], - [ - 0.4196064997861603, - 0.9076417582171769, - 0.010808518753297868, - 1.3188249413445081 - ], - [ - 0.005404464521362285, - -0.014405449810717353, - 0.9998816303838111, - 0.1274632305085777 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8583, - "backend_objective": 136.48820805392816, - "backend_elapsed_sec": 0.20632689999911236, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9286575562700965, - "inlier_rmse_m": 0.3573238301293189, - "target_points": 4774, - "source_points": 4976 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8311398354876616, - "inlier_rmse_m": 0.19178766673394962, - "target_points": 8207, - "source_points": 8510 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7221100454316002, - "inlier_rmse_m": 0.12610375237029928, - "target_points": 11817, - "source_points": 11886 - } - ], - "heldout_symmetric": { - "evaluated": 8074, - "inliers": 5992, - "inlier_ratio": 0.742135248947238, - "inlier_rmse_m": 0.1176855237061111, - "median_m": 0.12447711501955198, - "p90_m": 0.6833515897771322, - "p95_m": 1.2182338296829252 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3487.5252728593236, - 6162.1995764900175, - 7045.273113539118, - 8582.999999999995, - 12154.808541169885, - 15371.795939133171 - ], - "effective_rank": 6, - "scaled_condition_number": 4.407651482488117, - "weakest_scaled_direction": [ - 0.8629438902816486, - -0.06818220702804362, - -0.006597400741200934, - 0.007495719244895708, - 0.14133507228925002, - -0.48021215593507566 - ] - }, - "forward_reverse": { - "translation_m": 0.013825313356667012, - "rotation_deg": 0.06962701621921227 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.5766608620201505e-15, - "rotation_deg": 2.875488262593082e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254309.6379356, - "frame_counter_i": 290, - "frame_counter_j": 2618, - "rtk_translation_m": 8.883155687691525, - "rtk_rotation_deg": 14.186041609026283, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9704689596047816, - -0.2412095257374372, - -0.0028219031051621613, - 8.337206167993502 - ], - [ - 0.2411491486359032, - 0.9697979428258071, - 0.03659287093153323, - 3.2745915154819163 - ], - [ - -0.006089873216526363, - -0.03619274491321994, - 0.9993262723754703, - 0.2458950341466827 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6785, - "backend_objective": 117.02835020820989, - "backend_elapsed_sec": 0.34990909999760333, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8644031141868512, - "inlier_rmse_m": 0.40780538285996776, - "target_points": 4774, - "source_points": 4624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7426958016204273, - "inlier_rmse_m": 0.21536217048478815, - "target_points": 8207, - "source_points": 8146 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5903593491690594, - "inlier_rmse_m": 0.13133201733744648, - "target_points": 11817, - "source_points": 11493 - } - ], - "heldout_symmetric": { - "evaluated": 8111, - "inliers": 4990, - "inlier_ratio": 0.6152139070398225, - "inlier_rmse_m": 0.12748244203393638, - "median_m": 0.17079380386037657, - "p90_m": 1.060352112880509, - "p95_m": 1.7837815296124173 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2078.9884698728943, - 3449.8776955119365, - 3967.2397122838397, - 6785.0, - 13245.739456511768, - 15337.483418021891 - ], - "effective_rank": 6, - "scaled_condition_number": 7.377377816318336, - "weakest_scaled_direction": [ - 0.7382628269969982, - -0.21724248972749047, - -0.0145235636685449, - 0.018971817953952332, - 0.10653513451345092, - -0.6291685785761164 - ] - }, - "forward_reverse": { - "translation_m": 0.010848197501521375, - "rotation_deg": 0.23936253539883626 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7235296186091125e-15, - "rotation_deg": 1.4077521827072925e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 290, - "frame_counter_j": 4051, - "rtk_translation_m": 5.800196618465403, - "rtk_rotation_deg": 50.885974946353855, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6394558145362231, - -0.7685199936953565, - -0.021755011981310374, - 5.217096068536282 - ], - [ - 0.7688192669632673, - 0.6393263248789327, - 0.013371053169529745, - 2.058517060359087 - ], - [ - 0.0036326301601610437, - -0.025275870059976936, - 0.9996739140293855, - 0.1638496791678232 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8174, - "backend_objective": 126.48380281272681, - "backend_elapsed_sec": 0.35467590000189375, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9118844118844119, - "inlier_rmse_m": 0.3625052502673153, - "target_points": 4774, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8166333842358745, - "inlier_rmse_m": 0.19591505732216624, - "target_points": 8207, - "source_points": 8513 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6957780047667688, - "inlier_rmse_m": 0.12439420260952146, - "target_points": 11817, - "source_points": 11748 - } - ], - "heldout_symmetric": { - "evaluated": 8067, - "inliers": 5809, - "inlier_ratio": 0.7200942109830172, - "inlier_rmse_m": 0.11742249635115339, - "median_m": 0.12788031892006468, - "p90_m": 0.7782300021611404, - "p95_m": 1.37579369425793 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3069.7857561302944, - 5015.962750050762, - 5732.968018233336, - 8174.000000000004, - 12816.820435433676, - 15447.11441271811 - ], - "effective_rank": 6, - "scaled_condition_number": 5.031984522656203, - "weakest_scaled_direction": [ - 0.8335431569336815, - -0.11562655987004822, - -0.007504882673059492, - 0.012558988177940779, - 0.12464110112888195, - -0.5254396717445684 - ] - }, - "forward_reverse": { - "translation_m": 0.010896220625647894, - "rotation_deg": 0.1047126090415015 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.457101633618084e-15, - "rotation_deg": 2.3546691779846176e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254309.6379356, - "frame_counter_i": 1629, - "frame_counter_j": 2618, - "rtk_translation_m": 4.892046307546544, - "rtk_rotation_deg": 10.426600007662538, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9820681199186115, - 0.18761518435853894, - 0.01851352040097418, - 4.883933014778139 - ], - [ - -0.18799530022559005, - 0.9819341022847974, - 0.021521753256633556, - -0.10881834026733915 - ], - [ - -0.014141249330099592, - -0.024616282584108123, - 0.9995969506251624, - 0.1007202855096195 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8126, - "backend_objective": 115.98338837764001, - "backend_elapsed_sec": 0.2969897000002675, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9191176470588235, - "inlier_rmse_m": 0.3597621480686752, - "target_points": 4976, - "source_points": 4624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8186840166953105, - "inlier_rmse_m": 0.19098344339508153, - "target_points": 8510, - "source_points": 8146 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7070390672583312, - "inlier_rmse_m": 0.11947017149745912, - "target_points": 11886, - "source_points": 11493 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 5905, - "inlier_ratio": 0.7419273778112828, - "inlier_rmse_m": 0.11333156226718596, - "median_m": 0.11679695465497032, - "p90_m": 0.713766433607645, - "p95_m": 1.1276609892952019 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3091.526758023137, - 5194.2174832696855, - 6041.463710646636, - 8126.000000000003, - 11445.352396132512, - 13786.364248691974 - ], - "effective_rank": 6, - "scaled_condition_number": 4.459403177706152, - "weakest_scaled_direction": [ - 0.7253292042947723, - -0.5338224071459983, - -0.013441443133475865, - 0.060345123776649995, - 0.09257332097195482, - -0.42016563033291804 - ] - }, - "forward_reverse": { - "translation_m": 0.011700301190659394, - "rotation_deg": 0.07531112640817904 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.002966042486721e-16, - "rotation_deg": 1.050222835781751e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 1629, - "frame_counter_j": 4051, - "rtk_translation_m": 1.7315947839093804, - "rtk_rotation_deg": 26.273333329665036, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9030848171265954, - -0.4294395437645605, - -0.004414898267314201, - 1.5233286014368632 - ], - [ - 0.42945594896339373, - 0.9030795046119532, - 0.003872499164679167, - 0.1105081115684492 - ], - [ - 0.002323999865649817, - -0.005393199524923441, - 0.9999827560630775, - 0.03786888122206228 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9949, - "backend_objective": 129.7117642223831, - "backend_elapsed_sec": 0.3049659000025713, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9772079772079773, - "inlier_rmse_m": 0.27549103571506317, - "target_points": 4976, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.928462351697404, - "inlier_rmse_m": 0.1629455473874296, - "target_points": 8510, - "source_points": 8513 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8468675519237318, - "inlier_rmse_m": 0.11418261046127048, - "target_points": 11886, - "source_points": 11748 - } - ], - "heldout_symmetric": { - "evaluated": 7915, - "inliers": 6814, - "inlier_ratio": 0.860897030953885, - "inlier_rmse_m": 0.10772639754828932, - "median_m": 0.0932328870869559, - "p90_m": 0.3138777775066678, - "p95_m": 0.538453331558145 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5004.585636621727, - 8998.457285163893, - 9948.999999999996, - 10010.688063750398, - 11566.063204146467, - 15983.526199378415 - ], - "effective_rank": 6, - "scaled_condition_number": 3.19377614050938, - "weakest_scaled_direction": [ - 0.8804976341998426, - -0.39026005246671425, - -0.00480266063422935, - 0.06696772556183224, - 0.1536814053898049, - -0.21046446597580193 - ] - }, - "forward_reverse": { - "translation_m": 0.0031419813068167823, - "rotation_deg": 0.07553165598013784 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3683702862097964e-15, - "rotation_deg": 1.867976686828838e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 1629, - "frame_counter_j": 4925, - "rtk_translation_m": 1.6946255625760025, - "rtk_rotation_deg": 60.40345832959281, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.515439906424804, - -0.8566944888321617, - -0.01990617164071877, - -0.3101523142466175 - ], - [ - 0.8569210492024668, - 0.5152212417622511, - 0.015277024275273764, - -0.5556572822719978 - ], - [ - -0.002831660030918551, - -0.024932405450865665, - 0.9996851288580347, - -0.008401273671615054 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10113, - "backend_objective": 126.51672410249097, - "backend_elapsed_sec": 0.44810359999974025, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9748733108108109, - "inlier_rmse_m": 0.26405893940075176, - "target_points": 4976, - "source_points": 4736 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9358866610637532, - "inlier_rmse_m": 0.16275157305008314, - "target_points": 8510, - "source_points": 8329 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8534177215189873, - "inlier_rmse_m": 0.11184947900182825, - "target_points": 11886, - "source_points": 11850 - } - ], - "heldout_symmetric": { - "evaluated": 8000, - "inliers": 7055, - "inlier_ratio": 0.881875, - "inlier_rmse_m": 0.10577894988132426, - "median_m": 0.08700218214676275, - "p90_m": 0.28015971283859414, - "p95_m": 0.47993342346081286 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5049.6637167975305, - 9496.412490078545, - 10113.0, - 10278.832701014748, - 11283.995455016195, - 15618.426687912706 - ], - "effective_rank": 6, - "scaled_condition_number": 3.092963722704653, - "weakest_scaled_direction": [ - 0.8687185961081703, - -0.46125588997688305, - 0.013030346300304028, - 0.07728048873854794, - 0.14338389405950164, - -0.07661592391560852 - ] - }, - "forward_reverse": { - "translation_m": 0.004385743087150129, - "rotation_deg": 0.11984963227966941 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.336814180491474e-15, - "rotation_deg": 2.9946558365638174e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 2618, - "frame_counter_j": 4051, - "rtk_translation_m": 3.2805755806518446, - "rtk_rotation_deg": 36.69993333732758, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8057514399240561, - -0.5917425540022928, - -0.024604203769963365, - -3.330702341137891 - ], - [ - 0.5914216726187908, - 0.8061261467046512, - -0.019520265262119762, - -0.41959891876439753 - ], - [ - 0.03138506359882562, - 0.001177022495567254, - 0.9995066745154542, - -0.11079479904830754 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8840, - "backend_objective": 122.06165376015996, - "backend_elapsed_sec": 0.29287099999783095, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9489214489214489, - "inlier_rmse_m": 0.33984012625974, - "target_points": 4624, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.867966639257606, - "inlier_rmse_m": 0.18537933562214431, - "target_points": 8146, - "source_points": 8513 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7524685052774941, - "inlier_rmse_m": 0.1175069333470731, - "target_points": 11493, - "source_points": 11748 - } - ], - "heldout_symmetric": { - "evaluated": 7952, - "inliers": 6309, - "inlier_ratio": 0.7933853118712274, - "inlier_rmse_m": 0.10942029884827265, - "median_m": 0.10390042259024466, - "p90_m": 0.48870581647823075, - "p95_m": 0.8750178803170471 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3927.199711592826, - 6875.393828420819, - 7860.525638385458, - 8840.0, - 11566.310416506933, - 14532.526857349874 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7004807304428255, - "weakest_scaled_direction": [ - 0.8626064591940032, - -0.42866416600780566, - 0.020345219171531512, - 0.05085591409837494, - 0.11359490287470798, - 0.23717730801361067 - ] - }, - "forward_reverse": { - "translation_m": 0.008219359847113026, - "rotation_deg": 0.1277049389798412 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7611672763924622e-15, - "rotation_deg": 2.7962661693446796e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 2618, - "frame_counter_j": 4925, - "rtk_translation_m": 4.866335020594746, - "rtk_rotation_deg": 70.83005833725535, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3449900563455399, - -0.9378942875244395, - -0.03655361065239464, - -5.01570712883821 - ], - [ - 0.9382624271665987, - 0.3456561810038152, - -0.013616985764208785, - -1.4097871719532402 - ], - [ - 0.025406274621560157, - -0.029599154766367822, - 0.9992389159990571, - -0.21979215316361908 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7834, - "backend_objective": 129.35993618103245, - "backend_elapsed_sec": 0.3856140999996569, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9106841216216216, - "inlier_rmse_m": 0.39790813877592907, - "target_points": 4624, - "source_points": 4736 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7949333653499819, - "inlier_rmse_m": 0.20439933886077502, - "target_points": 8146, - "source_points": 8329 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6610970464135021, - "inlier_rmse_m": 0.12850147499525102, - "target_points": 11493, - "source_points": 11850 - } - ], - "heldout_symmetric": { - "evaluated": 8037, - "inliers": 5730, - "inlier_ratio": 0.7129525942515864, - "inlier_rmse_m": 0.11823277244188567, - "median_m": 0.12939052335086473, - "p90_m": 0.7977392149108958, - "p95_m": 1.29622256577361 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3714.160888049129, - 4769.350711607664, - 6122.578325202131, - 7833.999999999999, - 10725.302923739382, - 13076.755386207165 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5207832348575936, - "weakest_scaled_direction": [ - 0.8663084819440693, - -0.3590563419218451, - 0.042354088844121326, - 0.03902843268666416, - 0.1314651516940458, - 0.31620876636762296 - ] - }, - "forward_reverse": { - "translation_m": 0.003926646926802803, - "rotation_deg": 0.12676782091003777 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.280672456422863e-15, - "rotation_deg": 1.6726356851293157e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 2618, - "frame_counter_j": 6824, - "rtk_translation_m": 1.8274406190287722, - "rtk_rotation_deg": 30.448549979291712, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8594063653300414, - 0.5111832811924345, - -0.010599634877852105, - -1.1701399075984227 - ], - [ - -0.5112003921851377, - 0.8586708669265266, - -0.03685785291372985, - -2.223508159723186 - ], - [ - -0.009739520520478658, - 0.037094410913035135, - 0.999264302584179, - -0.11788903608111978 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8340, - "backend_objective": 133.9448601936981, - "backend_elapsed_sec": 0.38044519999675686, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9393939393939394, - "inlier_rmse_m": 0.3586560311320812, - "target_points": 4624, - "source_points": 4950 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8360177404295052, - "inlier_rmse_m": 0.20026760572497002, - "target_points": 8146, - "source_points": 8568 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.694594819688515, - "inlier_rmse_m": 0.12673016529385356, - "target_points": 11493, - "source_points": 12007 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 6015, - "inlier_ratio": 0.7434186132740082, - "inlier_rmse_m": 0.11591916677323456, - "median_m": 0.11944031523366729, - "p90_m": 0.6035445428438665, - "p95_m": 0.9686877498947937 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3933.871299900404, - 7129.531608666611, - 8191.097540229355, - 8340.000000000004, - 9048.322175037465, - 12685.127336730635 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2245913426430066, - "weakest_scaled_direction": [ - 0.7874288503302106, - -0.4927963543578693, - 0.0014928391376780356, - 0.06543485334273177, - 0.10561362750320201, - 0.34881137006149204 - ] - }, - "forward_reverse": { - "translation_m": 0.005762289421636631, - "rotation_deg": 0.0417195018069042 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.743794908190346e-16, - "rotation_deg": 7.989421182976738e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 4051, - "frame_counter_j": 4925, - "rtk_translation_m": 1.75881263274858, - "rtk_rotation_deg": 34.13012499992777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8334991076370967, - -0.5524370537549794, - -0.009619730073309634, - -1.9454716698982908 - ], - [ - 0.5525206620958213, - 0.833360129610813, - 0.015225384469578874, - 0.19385657358861477 - ], - [ - -0.0003943670379466212, - -0.018005443998113813, - 0.9998378110779117, - -0.03355737316226341 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9606, - "backend_objective": 140.1301924556676, - "backend_elapsed_sec": 0.3119323999999324, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9755067567567568, - "inlier_rmse_m": 0.3132150017750473, - "target_points": 4914, - "source_points": 4736 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9056309280826029, - "inlier_rmse_m": 0.18106418828167525, - "target_points": 8513, - "source_points": 8329 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.810632911392405, - "inlier_rmse_m": 0.12077987285310152, - "target_points": 11748, - "source_points": 11850 - } - ], - "heldout_symmetric": { - "evaluated": 7993, - "inliers": 6709, - "inlier_ratio": 0.8393594395095709, - "inlier_rmse_m": 0.11198421236679276, - "median_m": 0.09688348211734295, - "p90_m": 0.3820462999416218, - "p95_m": 0.627837158465495 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4628.9605995443735, - 7847.7612048659685, - 9355.673260925452, - 9606.0, - 10810.723185751169, - 13866.42006215428 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9955796261301395, - "weakest_scaled_direction": [ - 0.6270346974340657, - -0.762864871567465, - 0.021402353260178857, - 0.11967629650571351, - 0.09886197405134611, - 0.017621275731309862 - ] - }, - "forward_reverse": { - "translation_m": 0.016040499501420776, - "rotation_deg": 0.10475252258183747 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3859430966301474e-15, - "rotation_deg": 1.4846819485968587e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 4051, - "frame_counter_j": 6824, - "rtk_translation_m": 2.1020200425132134, - "rtk_rotation_deg": 67.14848331661929, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3899906610357696, - 0.9208188115639927, - 2.3974118275453706e-05, - 0.6707331222339533 - ], - [ - -0.9205537365837075, - 0.3898790193075872, - -0.02398266802363842, - -2.726008032049862 - ], - [ - -0.022093038873382577, - 0.009330947091780409, - 0.9997123741655455, - -0.019631939218335497 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8871, - "backend_objective": 134.59087690125088, - "backend_elapsed_sec": 0.7359578999967198, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9553535353535354, - "inlier_rmse_m": 0.3433666751329952, - "target_points": 4914, - "source_points": 4950 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8567927170868347, - "inlier_rmse_m": 0.18533717825066165, - "target_points": 8513, - "source_points": 8568 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7388190222370284, - "inlier_rmse_m": 0.12317470241942703, - "target_points": 11748, - "source_points": 12007 - } - ], - "heldout_symmetric": { - "evaluated": 8047, - "inliers": 6391, - "inlier_ratio": 0.7942090219957748, - "inlier_rmse_m": 0.1150960059583273, - "median_m": 0.10843992165703668, - "p90_m": 0.49220081035990987, - "p95_m": 0.845657429250885 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4332.118042242123, - 7233.732621511632, - 8278.434983963827, - 8871.000000000002, - 11765.813687966063, - 15018.292053384605 - ], - "effective_rank": 6, - "scaled_condition_number": 3.466731955810642, - "weakest_scaled_direction": [ - 0.5208517428093219, - -0.8352135272478309, - -0.022645690979919385, - 0.13959510945771078, - 0.08860669806110023, - -0.05728051212209651 - ] - }, - "forward_reverse": { - "translation_m": 0.01716401750472473, - "rotation_deg": 0.19985666972488197 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.899967903858578e-15, - "rotation_deg": 1.5665844110819207e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 4051, - "frame_counter_j": 8269, - "rtk_translation_m": 5.791805311102367, - "rtk_rotation_deg": 61.163322289150074, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4870399721799273, - 0.8733790372281756, - -0.0010596364284145283, - 2.3178066354630755 - ], - [ - -0.8731212277737674, - 0.48686597417107796, - -0.024916757519328852, - -6.115419553586503 - ], - [ - -0.02124587277109215, - 0.01306064794839901, - 0.9996889678121685, - -0.002935473307306152 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7327, - "backend_objective": 115.56967838640843, - "backend_elapsed_sec": 0.6317248999985168, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9001829640170766, - "inlier_rmse_m": 0.40820379356608716, - "target_points": 4914, - "source_points": 4919 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.742132456552372, - "inlier_rmse_m": 0.19944101781980828, - "target_points": 8513, - "source_points": 8516 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6058376054241773, - "inlier_rmse_m": 0.12559109777951713, - "target_points": 11748, - "source_points": 12094 - } - ], - "heldout_symmetric": { - "evaluated": 7970, - "inliers": 5208, - "inlier_ratio": 0.6534504391468005, - "inlier_rmse_m": 0.12221285442048085, - "median_m": 0.15352147543102576, - "p90_m": 0.9163075294870671, - "p95_m": 1.3199312018291032 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3731.03877984718, - 4348.1777784283695, - 5464.198048483968, - 7326.999999999998, - 12488.273729984066, - 15168.71675212033 - ], - "effective_rank": 6, - "scaled_condition_number": 4.065547866736895, - "weakest_scaled_direction": [ - -0.30301929276339806, - 0.8742060518328426, - 0.06754357311059203, - -0.20879997223492774, - -0.09512909427262196, - 0.294506332531275 - ] - }, - "forward_reverse": { - "translation_m": 0.010758157432153631, - "rotation_deg": 0.2541461196933768 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.924053400677013e-15, - "rotation_deg": 3.7336816561866225e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 4925, - "frame_counter_j": 6824, - "rtk_translation_m": 3.30592832159088, - "rtk_rotation_deg": 101.27860831654709, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.18365489298164756, - 0.9828799237501701, - -0.0147626478912096, - 0.5670554360101745 - ], - [ - -0.982384810146423, - -0.1840482257945119, - -0.032347107683220716, - -3.880054719387501 - ], - [ - -0.03451036188562875, - 0.008561896446036712, - 0.999367664501794, - -0.012153759216117627 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8404, - "backend_objective": 120.67293108763258, - "backend_elapsed_sec": 0.31687139999849023, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9234343434343434, - "inlier_rmse_m": 0.368847055297609, - "target_points": 4736, - "source_points": 4950 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8077731092436975, - "inlier_rmse_m": 0.18779046707507435, - "target_points": 8329, - "source_points": 8568 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.699925043724494, - "inlier_rmse_m": 0.11982899280381619, - "target_points": 11850, - "source_points": 12007 - } - ], - "heldout_symmetric": { - "evaluated": 8132, - "inliers": 6115, - "inlier_ratio": 0.7519675356615839, - "inlier_rmse_m": 0.11239744207499523, - "median_m": 0.11360124389594242, - "p90_m": 0.6807400855347308, - "p95_m": 1.118306050155756 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3855.1234441138504, - 5863.358940949755, - 7076.700315109171, - 8404.000000000002, - 10831.097172319818, - 13641.076636680551 - ], - "effective_rank": 6, - "scaled_condition_number": 3.538427973689991, - "weakest_scaled_direction": [ - 0.15530559116947557, - 0.8926112546145117, - 0.04486365577580256, - -0.1593516936536239, - 0.008152601695395858, - 0.3894266897539959 - ] - }, - "forward_reverse": { - "translation_m": 0.007054246334297592, - "rotation_deg": 0.24517862996973167 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5462998954914225e-15, - "rotation_deg": 1.4208880271338045e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 4925, - "frame_counter_j": 8269, - "rtk_translation_m": 6.453995240105232, - "rtk_rotation_deg": 95.29344728907782, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07647342763812547, - 0.9969476001742427, - -0.01572569146635118, - 0.06890892190067457 - ], - [ - -0.9963524993971391, - -0.07700767197288139, - -0.03676296237236636, - -7.612678870947924 - ], - [ - -0.03786174600241414, - 0.01285694225450099, - 0.9992002738317843, - -0.0703879517057813 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7125, - "backend_objective": 121.52013450126266, - "backend_elapsed_sec": 0.349759400000039, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.861760520430982, - "inlier_rmse_m": 0.41723255599415515, - "target_points": 4736, - "source_points": 4919 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7118365429779239, - "inlier_rmse_m": 0.20036827849533434, - "target_points": 8329, - "source_points": 8516 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5891351083181743, - "inlier_rmse_m": 0.13059654464748072, - "target_points": 11850, - "source_points": 12094 - } - ], - "heldout_symmetric": { - "evaluated": 8055, - "inliers": 5017, - "inlier_ratio": 0.6228429546865301, - "inlier_rmse_m": 0.12861898753238143, - "median_m": 0.17247038666404324, - "p90_m": 1.1390551698329061, - "p95_m": 1.6259740643437726 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3158.307741539817, - 4274.153177978126, - 4975.782840778052, - 7125.0, - 13729.867845162573, - 16549.276669312796 - ], - "effective_rank": 6, - "scaled_condition_number": 5.239918976750594, - "weakest_scaled_direction": [ - -0.28374285505582636, - -0.7131423559427895, - -0.052117484650875255, - 0.1732535232456722, - -0.024025162658607203, - -0.6144979645214376 - ] - }, - "forward_reverse": { - "translation_m": 0.01896562608787198, - "rotation_deg": 0.25933537698897335 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.074810500188957e-15, - "rotation_deg": 1.0004736395231324e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 4925, - "frame_counter_j": 9966, - "rtk_translation_m": 9.537609568572432, - "rtk_rotation_deg": 26.32130681988008, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9013205645481858, - 0.43295435322397724, - 0.013106027123014287, - 2.7907796208543565 - ], - [ - -0.4329336567423206, - 0.9014144330082822, - -0.004524248454812887, - -9.645119964538162 - ], - [ - -0.013772755071661173, - -0.0015962420762824026, - 0.9999038769946688, - -0.024473717216209733 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6826, - "backend_objective": 122.29450546380481, - "backend_elapsed_sec": 0.2978263999975752, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8803088803088803, - "inlier_rmse_m": 0.4128960113764234, - "target_points": 4736, - "source_points": 4662 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7491876278733903, - "inlier_rmse_m": 0.20983670762451587, - "target_points": 8329, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5951176983435048, - "inlier_rmse_m": 0.13385060256342945, - "target_points": 11850, - "source_points": 11470 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 4883, - "inlier_ratio": 0.6193556570268899, - "inlier_rmse_m": 0.13116150037214716, - "median_m": 0.17572991660354748, - "p90_m": 0.9605375918561906, - "p95_m": 1.4912793286208175 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2431.7797022910895, - 3530.885873335949, - 4001.4336516695803, - 6826.000000000002, - 14595.39009140799, - 16877.816389287487 - ], - "effective_rank": 6, - "scaled_condition_number": 6.94052030016787, - "weakest_scaled_direction": [ - -0.2503351871250935, - -0.7062041401465033, - -0.0373633873598344, - 0.12085779549415662, - -0.008450503935209347, - -0.6500261272160639 - ] - }, - "forward_reverse": { - "translation_m": 0.01746189088684816, - "rotation_deg": 0.36780633600082835 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.914520981537836e-16, - "rotation_deg": 1.4679133649196167e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 6824, - "frame_counter_j": 8269, - "rtk_translation_m": 3.7769167422851373, - "rtk_rotation_deg": 5.985161027469212, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9941758129997665, - -0.1077581058073882, - 0.0016258779346163103, - 3.758717829226408 - ], - [ - 0.10775836821878204, - 0.99417711125413, - -7.441249255798297e-05, - 0.19434194849920733 - ], - [ - -0.0016083920790422204, - 0.00024918105344334877, - 0.9999986754909838, - 0.07087804507161632 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8527, - "backend_objective": 132.38775795464312, - "backend_elapsed_sec": 0.29321499999787193, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9487700752185404, - "inlier_rmse_m": 0.34891530468853427, - "target_points": 4950, - "source_points": 4919 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8392437764208549, - "inlier_rmse_m": 0.19538381132761035, - "target_points": 8568, - "source_points": 8516 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7050603605093435, - "inlier_rmse_m": 0.12460222058898378, - "target_points": 12007, - "source_points": 12094 - } - ], - "heldout_symmetric": { - "evaluated": 8109, - "inliers": 5988, - "inlier_ratio": 0.7384387717351092, - "inlier_rmse_m": 0.11889495868628594, - "median_m": 0.12417931167111575, - "p90_m": 0.6236564828936758, - "p95_m": 0.9130712272932255 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4140.129563751491, - 6189.6803234601875, - 7326.7647498538345, - 8527.000000000002, - 11744.069254029602, - 14928.171894831929 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6057257786167156, - "weakest_scaled_direction": [ - 0.9067362342629384, - -0.09928364301128528, - -0.0256166685198575, - 0.009236779547716649, - 0.17919974088712368, - -0.3675841138686379 - ] - }, - "forward_reverse": { - "translation_m": 0.00882639593332281, - "rotation_deg": 0.0737386250122742 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4206697122486918e-15, - "rotation_deg": 1.6571970554193366e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 6824, - "frame_counter_j": 9966, - "rtk_translation_m": 6.565348405821576, - "rtk_rotation_deg": 74.95730149666699, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.260738660719617, - -0.9647786945213821, - -0.03489156637009747, - 5.2685928377943325 - ], - [ - 0.9653170116890141, - 0.2600433182146046, - 0.023249507429874902, - 3.248987467028237 - ], - [ - -0.01335731072987463, - -0.039743468011187735, - 0.9991206328569684, - 0.1325047467234585 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7767, - "backend_objective": 117.3524646007548, - "backend_elapsed_sec": 0.3686136999967857, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9124839124839125, - "inlier_rmse_m": 0.3680828733414946, - "target_points": 4950, - "source_points": 4662 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8127331808881936, - "inlier_rmse_m": 0.1937335161911719, - "target_points": 8568, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6771578029642545, - "inlier_rmse_m": 0.12291912353640713, - "target_points": 12007, - "source_points": 11470 - } - ], - "heldout_symmetric": { - "evaluated": 7938, - "inliers": 5392, - "inlier_ratio": 0.6792642983119174, - "inlier_rmse_m": 0.11864042030155272, - "median_m": 0.1389713831105742, - "p90_m": 0.8672054418803693, - "p95_m": 1.3490230862756831 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3090.9867982213646, - 5041.311061792313, - 5726.6703343355375, - 7767.000000000004, - 12335.37027061039, - 14899.817257098442 - ], - "effective_rank": 6, - "scaled_condition_number": 4.820407924638239, - "weakest_scaled_direction": [ - 0.8785930025423923, - 0.07786552824002801, - -0.006569734157052075, - -0.01421330130680051, - 0.12199888719034031, - -0.4548432560551294 - ] - }, - "forward_reverse": { - "translation_m": 0.009720083307578809, - "rotation_deg": 0.20972540690307045 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7919550765230803e-15, - "rotation_deg": 6.527504566631641e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 6824, - "frame_counter_j": 11343, - "rtk_translation_m": 6.3343271669452825, - "rtk_rotation_deg": 107.99940292217995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3029538265259511, - -0.9511007972450491, - -0.06021837321878844, - 4.007327323772453 - ], - [ - 0.9484604096589064, - -0.3070702342837781, - 0.07829893055824687, - -1.565922535085258 - ], - [ - -0.09296144524986465, - -0.03339378230657442, - 0.9951095542704419, - 0.09739371919462637 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7791, - "backend_objective": 128.3910339994467, - "backend_elapsed_sec": 0.37070849999872735, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8924799324038868, - "inlier_rmse_m": 0.38134089293410367, - "target_points": 4950, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7705054840247973, - "inlier_rmse_m": 0.1969481196580695, - "target_points": 8568, - "source_points": 8388 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6400230017251294, - "inlier_rmse_m": 0.12837212964982433, - "target_points": 12007, - "source_points": 12173 - } - ], - "heldout_symmetric": { - "evaluated": 8402, - "inliers": 5434, - "inlier_ratio": 0.6467507736253273, - "inlier_rmse_m": 0.12542317047495377, - "median_m": 0.16007959618621803, - "p90_m": 1.1946516873233035, - "p95_m": 1.9892393877347117 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4523.452077305281, - 5132.895213056975, - 6714.750585499182, - 7790.999999999996, - 10872.385770911158, - 13932.110840315123 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0799731272083655, - "weakest_scaled_direction": [ - 0.9356174322433658, - -0.14190039625394926, - -0.03144452251486668, - 0.03561660486109257, - 0.2720573922476328, - -0.1679636056135422 - ] - }, - "forward_reverse": { - "translation_m": 0.01002585992591628, - "rotation_deg": 0.05691592874139322 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9891280697202825e-15, - "rotation_deg": 2.2303649157895953e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 8269, - "frame_counter_j": 9966, - "rtk_translation_m": 3.1558607172566147, - "rtk_rotation_deg": 68.97214046919777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.36333294682991346, - -0.9311173959260944, - -0.031773648699838994, - 1.8260229804166426 - ], - [ - 0.9315507873200539, - 0.3625586129334655, - 0.02764747422729666, - 2.8747153850629528 - ], - [ - -0.014223234206005424, - -0.039644005745773654, - 0.9991126324980335, - 0.06695895866965706 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8727, - "backend_objective": 124.74086071485762, - "backend_elapsed_sec": 0.32601839999551885, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9461604461604461, - "inlier_rmse_m": 0.3522356369111233, - "target_points": 4919, - "source_points": 4662 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8579853171260079, - "inlier_rmse_m": 0.17829616177140123, - "target_points": 8516, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7608544027898867, - "inlier_rmse_m": 0.11955613869966834, - "target_points": 12094, - "source_points": 11470 - } - ], - "heldout_symmetric": { - "evaluated": 7861, - "inliers": 5877, - "inlier_ratio": 0.7476148072764279, - "inlier_rmse_m": 0.11288592031143596, - "median_m": 0.11412737923106632, - "p90_m": 0.7434969348972533, - "p95_m": 1.2151835050516289 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3813.771294208023, - 6442.362600999084, - 7514.358586477534, - 8727.000000000002, - 10560.297899136065, - 13675.979106829363 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5859463118826977, - "weakest_scaled_direction": [ - 0.8811178269945527, - 0.10374166208666225, - 0.004753349334532734, - -0.011807405585548212, - 0.12068042208070956, - -0.44513286675975594 - ] - }, - "forward_reverse": { - "translation_m": 0.010814191328094169, - "rotation_deg": 0.0266481566439959 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.953491551845391e-14, - "rotation_deg": 1.8131416433495513e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 8269, - "frame_counter_j": 11343, - "rtk_translation_m": 3.3979014114419868, - "rtk_rotation_deg": 102.01424189471071, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.19842688516599596, - -0.9784073164295477, - -0.0578437066624485, - 0.05237239518020323 - ], - [ - 0.975782423904139, - -0.20274874647537586, - 0.08210728958154492, - -1.7736156760135489 - ], - [ - -0.0920621118760839, - -0.04015057857359556, - 0.994943465025587, - 0.007897273429794021 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8201, - "backend_objective": 121.678481021088, - "backend_elapsed_sec": 0.29722659999970347, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8793831854668357, - "inlier_rmse_m": 0.35475261502060756, - "target_points": 4919, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7762279446828803, - "inlier_rmse_m": 0.18529680378844623, - "target_points": 8516, - "source_points": 8388 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6737040992360142, - "inlier_rmse_m": 0.12180734688449874, - "target_points": 12094, - "source_points": 12173 - } - ], - "heldout_symmetric": { - "evaluated": 8325, - "inliers": 5665, - "inlier_ratio": 0.6804804804804805, - "inlier_rmse_m": 0.11508385505331041, - "median_m": 0.13562803658673447, - "p90_m": 1.3983479433265629, - "p95_m": 2.221412000764961 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5054.775852550768, - 6067.992324194449, - 8201.000000000002, - 8335.886772693791, - 8598.467160307708, - 11477.81743874908 - ], - "effective_rank": 6, - "scaled_condition_number": 2.2706877166387276, - "weakest_scaled_direction": [ - 0.9381146557795784, - 0.2419716515305383, - 0.01375551004316066, - -0.06168683520980203, - 0.23949938318090888, - -0.0060148340261598696 - ] - }, - "forward_reverse": { - "translation_m": 0.004482804469688638, - "rotation_deg": 0.1044466289150781 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.791609379366768e-15, - "rotation_deg": 6.732594425537964e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 8269, - "frame_counter_j": 14121, - "rtk_translation_m": 0.28270347875173524, - "rtk_rotation_deg": 124.11602215258995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5644659743970785, - 0.8249766114409253, - -0.02813812935156164, - -1.7983324048390028 - ], - [ - -0.8239906876376839, - -0.5651667101374394, - -0.04032290216242627, - -0.9282198914644424 - ], - [ - -0.04916818518446621, - 0.00042465029359935663, - 0.9987904230807355, - -0.0503200648841223 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8571, - "backend_objective": 121.40028731185573, - "backend_elapsed_sec": 0.2846923999968567, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9563451776649746, - "inlier_rmse_m": 0.3273508999327092, - "target_points": 4919, - "source_points": 4925 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8664889750424036, - "inlier_rmse_m": 0.18338813383418842, - "target_points": 8516, - "source_points": 8254 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.751710226276092, - "inlier_rmse_m": 0.11901291970539449, - "target_points": 12094, - "source_points": 11402 - } - ], - "heldout_symmetric": { - "evaluated": 7872, - "inliers": 5803, - "inlier_ratio": 0.7371697154471545, - "inlier_rmse_m": 0.11682527448508172, - "median_m": 0.12328123131935259, - "p90_m": 0.618944594506951, - "p95_m": 0.8896906677839741 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4957.3464960133915, - 7026.261811749822, - 8317.19500609405, - 8570.999999999998, - 10443.995594058693, - 14364.26103730312 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8975705145594723, - "weakest_scaled_direction": [ - 0.9358401611850451, - -0.026923389775416362, - 0.031218615494114515, - 0.015402002179606116, - 0.23154821188532584, - -0.26201512502973595 - ] - }, - "forward_reverse": { - "translation_m": 0.005203408768588573, - "rotation_deg": 0.04849411501759064 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4516889106820108e-15, - "rotation_deg": 9.558007647116487e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 9966, - "frame_counter_j": 11343, - "rtk_translation_m": 4.78580085090425, - "rtk_rotation_deg": 33.04210142551296, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.837844157639851, - -0.5441341678960031, - 0.04399062214715602, - -4.973667369824471 - ], - [ - 0.542867391826453, - 0.8389609514899827, - 0.03794096422824007, - -0.03401913628280753 - ], - [ - -0.057551389212719746, - -0.00790754090400392, - 0.9983112282232111, - -0.1193313401238106 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7316, - "backend_objective": 107.37502071305822, - "backend_elapsed_sec": 0.4314015999989351, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8415716096324461, - "inlier_rmse_m": 0.40386065612586847, - "target_points": 4662, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7129232236528373, - "inlier_rmse_m": 0.1952700402703297, - "target_points": 8309, - "source_points": 8388 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6010022180234946, - "inlier_rmse_m": 0.12114759078276513, - "target_points": 11470, - "source_points": 12173 - } - ], - "heldout_symmetric": { - "evaluated": 8154, - "inliers": 5417, - "inlier_ratio": 0.664336521952416, - "inlier_rmse_m": 0.11766047279270792, - "median_m": 0.14227264729336248, - "p90_m": 1.2960882997602254, - "p95_m": 2.2382453550627477 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4006.3347688805397, - 5102.26483877646, - 6441.410986437274, - 7316.0, - 8967.341901764888, - 11734.83897019125 - ], - "effective_rank": 6, - "scaled_condition_number": 2.929070995599858, - "weakest_scaled_direction": [ - -0.3663844797046443, - 0.8033323160106102, - -0.023898854555835305, - -0.14016190621374572, - -0.07703757927858318, - -0.44075877672592145 - ] - }, - "forward_reverse": { - "translation_m": 0.0018478739597912201, - "rotation_deg": 0.09974755915747875 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1443916996305594e-15, - "rotation_deg": 9.630015586991387e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 9966, - "frame_counter_j": 14121, - "rtk_translation_m": 2.876695741106431, - "rtk_rotation_deg": 166.91183737821345, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9718216999418209, - -0.22643509073764045, - -0.06549605487985938, - -4.848127564270945 - ], - [ - 0.22873949752259115, - -0.9730242217530213, - -0.030035082071483227, - 1.994224775424967 - ], - [ - -0.05692825129319968, - -0.0441702791995321, - 0.9974007021453982, - -0.10148803356040642 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6834, - "backend_objective": 106.81544152109478, - "backend_elapsed_sec": 0.45778040000004694, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.849746192893401, - "inlier_rmse_m": 0.39505664654335493, - "target_points": 4662, - "source_points": 4925 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7219529924884904, - "inlier_rmse_m": 0.19772318699130403, - "target_points": 8309, - "source_points": 8254 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.59936853183652, - "inlier_rmse_m": 0.12502001099472546, - "target_points": 11470, - "source_points": 11402 - } - ], - "heldout_symmetric": { - "evaluated": 7701, - "inliers": 4680, - "inlier_ratio": 0.6077132839890923, - "inlier_rmse_m": 0.1180552047396233, - "median_m": 0.1591798202365504, - "p90_m": 1.3324725259645702, - "p95_m": 1.888902945076715 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3560.9203779643194, - 4557.2572669071615, - 5588.363842061524, - 6834.000000000001, - 10610.812839459322, - 13241.257607947542 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7184930305903685, - "weakest_scaled_direction": [ - 0.2037848717340521, - -0.9016523378054033, - 0.02348520910474819, - 0.19898060216293728, - 0.05331152306862292, - 0.3201684466131419 - ] - }, - "forward_reverse": { - "translation_m": 0.010919730241803961, - "rotation_deg": 0.14576304064343415 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3414875847488985e-15, - "rotation_deg": 3.349905706665016e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 9966, - "frame_counter_j": 16041, - "rtk_translation_m": 3.5227760858025783, - "rtk_rotation_deg": 151.5297683494061, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8911439541239367, - 0.4533475722425824, - -0.018396515162178294, - 0.7305393629607349 - ], - [ - -0.4527216153492907, - -0.8911397310907277, - -0.03021785344915802, - 0.8514636802940496 - ], - [ - -0.030093056074187993, - -0.018599957346801237, - 0.9993740288614734, - 0.017120582596430223 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9090, - "backend_objective": 114.66763395323056, - "backend_elapsed_sec": 0.22733639999933075, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9540386803185438, - "inlier_rmse_m": 0.27926929788331256, - "target_points": 4662, - "source_points": 4395 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8985375954445451, - "inlier_rmse_m": 0.16230623749667675, - "target_points": 8309, - "source_points": 7727 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.825988187187642, - "inlier_rmse_m": 0.11231518688483699, - "target_points": 11470, - "source_points": 11005 - } - ], - "heldout_symmetric": { - "evaluated": 7825, - "inliers": 6637, - "inlier_ratio": 0.8481789137380191, - "inlier_rmse_m": 0.10615102438506704, - "median_m": 0.08678439984237747, - "p90_m": 0.36758466012789104, - "p95_m": 0.788642973305644 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4578.416143367038, - 8105.773595974633, - 9090.0, - 9219.820234930676, - 9700.888093211779, - 13122.868232129276 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8662462784517695, - "weakest_scaled_direction": [ - -0.37211305372126585, - 0.9127376981552479, - 0.0019085575767675005, - -0.1559713375553601, - -0.06357030701954881, - -0.008359721951237981 - ] - }, - "forward_reverse": { - "translation_m": 0.006788694147854834, - "rotation_deg": 0.052872203183928275 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0585956984385433e-15, - "rotation_deg": 2.5379817608084486e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 11343, - "frame_counter_j": 14121, - "rtk_translation_m": 3.469611483011297, - "rtk_rotation_deg": 133.86973595269956, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6873719234152253, - -0.7151300426786867, - -0.12692068767082196, - 1.2013638677044556 - ], - [ - 0.7211531180034463, - -0.692772240441507, - -0.0021916358197803694, - 1.6432831081602304 - ], - [ - -0.08635982453875601, - -0.09303571858182247, - 0.9919104474566246, - 0.09854392649797582 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7219, - "backend_objective": 112.31880270847554, - "backend_elapsed_sec": 0.5311968000023626, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9100507614213198, - "inlier_rmse_m": 0.3849171983789123, - "target_points": 4734, - "source_points": 4925 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7622970680881996, - "inlier_rmse_m": 0.19684732055097146, - "target_points": 8388, - "source_points": 8254 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6331345378003859, - "inlier_rmse_m": 0.12473482203799797, - "target_points": 12173, - "source_points": 11402 - } - ], - "heldout_symmetric": { - "evaluated": 8165, - "inliers": 4853, - "inlier_ratio": 0.5943661971830986, - "inlier_rmse_m": 0.11920565901187036, - "median_m": 0.1703294972750188, - "p90_m": 1.484888520646017, - "p95_m": 2.235066265906113 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3599.7890471718347, - 6049.489676136014, - 7219.0, - 7426.349357391605, - 9411.579449446006, - 13637.359811975843 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7883774947006965, - "weakest_scaled_direction": [ - 0.1867440524379929, - 0.8162947220307215, - 0.004675141011696163, - -0.21296813590253966, - 0.04584967203625626, - 0.5013083974807409 - ] - }, - "forward_reverse": { - "translation_m": 0.0042443197269814905, - "rotation_deg": 0.10102914613043958 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.179547574777648e-15, - "rotation_deg": 3.647865661183593e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 11343, - "frame_counter_j": 16041, - "rtk_translation_m": 8.226583602288494, - "rtk_rotation_deg": 175.42813022508852, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.990590906799849, - -0.1025422475800327, - -0.09063521846771298, - 5.251428299592507 - ], - [ - 0.10513196662034079, - -0.9941622329184544, - -0.024263640145978062, - -2.360773498408186 - ], - [ - -0.08761806297787185, - -0.03356400005704444, - 0.9955885359626112, - 0.4146717358973483 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6820, - "backend_objective": 103.35483975108286, - "backend_elapsed_sec": 0.38254670000605984, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8282138794084186, - "inlier_rmse_m": 0.4133575413091762, - "target_points": 4734, - "source_points": 4395 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7084250032354084, - "inlier_rmse_m": 0.19410043806955288, - "target_points": 8388, - "source_points": 7727 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6197183098591549, - "inlier_rmse_m": 0.12310429962110489, - "target_points": 12173, - "source_points": 11005 - } - ], - "heldout_symmetric": { - "evaluated": 8289, - "inliers": 4911, - "inlier_ratio": 0.5924719507781397, - "inlier_rmse_m": 0.12046539737502422, - "median_m": 0.1712945001521798, - "p90_m": 1.8093385448338486, - "p95_m": 2.4882830621025454 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1952.6058704589846, - 3873.560796762434, - 4769.125529050902, - 6819.999999999998, - 10432.052916294395, - 12928.718853043985 - ], - "effective_rank": 6, - "scaled_condition_number": 6.6212639471399966, - "weakest_scaled_direction": [ - 0.11184088655760945, - 0.7505333038754209, - 0.02857303212547331, - -0.1318615682860996, - -0.00460729758239516, - 0.6371548142493525 - ] - }, - "forward_reverse": { - "translation_m": 0.012068925048483609, - "rotation_deg": 0.06971570917645852 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.70870825910788e-15, - "rotation_deg": 7.507827918318025e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 11343, - "frame_counter_j": 17319, - "rtk_translation_m": 1.865267488778983, - "rtk_rotation_deg": 173.7180803410843, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9941864822401622, - -0.10643880208658807, - -0.016248690448909444, - -3.1581346512257817 - ], - [ - 0.10684555777780605, - -0.9939186158636084, - -0.026642293874941773, - -1.6572298883064716 - ], - [ - -0.013314102075688675, - -0.028223508820509592, - 0.9995129655165941, - -0.02914447175471073 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8203, - "backend_objective": 114.13582617816311, - "backend_elapsed_sec": 0.3258672000010847, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.899582560296846, - "inlier_rmse_m": 0.37222576842825794, - "target_points": 4734, - "source_points": 4312 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7938391617220047, - "inlier_rmse_m": 0.1831997073876595, - "target_points": 8388, - "source_points": 7921 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7022515195616814, - "inlier_rmse_m": 0.11795724961433986, - "target_points": 12173, - "source_points": 11681 - } - ], - "heldout_symmetric": { - "evaluated": 8379, - "inliers": 5689, - "inlier_ratio": 0.6789593030194534, - "inlier_rmse_m": 0.1124672015619688, - "median_m": 0.129431920937627, - "p90_m": 1.0483491677108745, - "p95_m": 1.8020414856412397 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4439.531038349129, - 5232.610038587567, - 7949.630650690138, - 8203.000000000002, - 8558.68541060809, - 10361.677854363204 - ], - "effective_rank": 6, - "scaled_condition_number": 2.333957745729889, - "weakest_scaled_direction": [ - 0.9399835762259944, - 0.1663319017126061, - 0.0499608553053499, - -0.04250643823676861, - 0.16925160098347508, - 0.2362532245455505 - ] - }, - "forward_reverse": { - "translation_m": 0.006563181150688944, - "rotation_deg": 0.09301162138898374 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.478846402576706e-15, - "rotation_deg": 1.4441394092355008e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 14121, - "frame_counter_j": 16041, - "rtk_translation_m": 5.488028285806731, - "rtk_rotation_deg": 41.558394272381754, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7641098757020948, - -0.643648724483824, - -0.04303971799252167, - -5.689665903430853 - ], - [ - 0.6439800694122672, - 0.7650054064178788, - -0.007509883566541714, - -0.1646431310543818 - ], - [ - 0.03775934393360661, - -0.021978344381741104, - 0.9990451362796057, - -0.1909527925912045 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6582, - "backend_objective": 102.79917124575229, - "backend_elapsed_sec": 0.6541016999981366, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8516496018202503, - "inlier_rmse_m": 0.4044745710143411, - "target_points": 4925, - "source_points": 4395 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7164488158405591, - "inlier_rmse_m": 0.2022515135742748, - "target_points": 8254, - "source_points": 7727 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.598091776465243, - "inlier_rmse_m": 0.12497290575139303, - "target_points": 11402, - "source_points": 11005 - } - ], - "heldout_symmetric": { - "evaluated": 7836, - "inliers": 4714, - "inlier_ratio": 0.6015824400204186, - "inlier_rmse_m": 0.11914584090399423, - "median_m": 0.16569610212740835, - "p90_m": 1.3690893299575624, - "p95_m": 1.9518229337412154 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2258.3769075175046, - 4557.288060248362, - 5506.869507018702, - 6582.000000000001, - 9530.922391599586, - 12400.434486654343 - ], - "effective_rank": 6, - "scaled_condition_number": 5.490861355062907, - "weakest_scaled_direction": [ - 0.46244517980133026, - -0.6635454963428417, - 0.018948090663738655, - 0.062277346135704924, - 0.0600050475950288, - 0.581389478958175 - ] - }, - "forward_reverse": { - "translation_m": 0.023677817470035802, - "rotation_deg": 0.12091279277864625 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.920192669818882e-15, - "rotation_deg": 5.70397817287108e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 14121, - "frame_counter_j": 17319, - "rtk_translation_m": 4.718056434111957, - "rtk_rotation_deg": 39.84834438838189, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7609590895293387, - -0.640896212014289, - -0.10096192098221174, - 0.6341363959419922 - ], - [ - 0.6384153235368881, - 0.7673881044767814, - -0.05950942598292705, - 5.41373571928287 - ], - [ - 0.11561634285847687, - -0.019171398834383024, - 0.9931089158449637, - 0.4353081744805041 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6992, - "backend_objective": 108.53745236566908, - "backend_elapsed_sec": 0.5646972999966238, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8513450834879406, - "inlier_rmse_m": 0.4093381560435911, - "target_points": 4925, - "source_points": 4312 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7009216008079788, - "inlier_rmse_m": 0.1973282312572818, - "target_points": 8254, - "source_points": 7921 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5985788887937676, - "inlier_rmse_m": 0.12459169720890959, - "target_points": 11402, - "source_points": 11681 - } - ], - "heldout_symmetric": { - "evaluated": 7926, - "inliers": 4705, - "inlier_ratio": 0.5936159475145092, - "inlier_rmse_m": 0.12220038333634799, - "median_m": 0.17276335681673644, - "p90_m": 1.4699644383074366, - "p95_m": 2.30641435125395 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3602.6996953225494, - 4604.684430332108, - 6140.334568254982, - 6992.000000000002, - 8425.049154201206, - 10719.75211669279 - ], - "effective_rank": 6, - "scaled_condition_number": 2.975477564952316, - "weakest_scaled_direction": [ - -0.3423449081838605, - -0.8113946691834535, - -0.0008144951864184363, - 0.17189878320072838, - -0.07296485780064338, - 0.43539054780632386 - ] - }, - "forward_reverse": { - "translation_m": 0.010739868846460122, - "rotation_deg": 0.11267510434066752 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6460396088832653e-15, - "rotation_deg": 2.4709860987181893e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 14121, - "frame_counter_j": 19292, - "rtk_translation_m": 4.0664516687652705, - "rtk_rotation_deg": 11.300244475855449, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9752736075095606, - -0.20746019547991082, - -0.07616861418408684, - 0.6104177099304621 - ], - [ - 0.20168036572269854, - 0.9764116803910103, - -0.07710551522401696, - 4.244411281064189 - ], - [ - 0.09036824982949265, - 0.05983726002617257, - 0.9941091900467046, - 0.3044246944984888 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7213, - "backend_objective": 113.8928943404258, - "backend_elapsed_sec": 0.22952770000119926, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8702633269107257, - "inlier_rmse_m": 0.3835259773984643, - "target_points": 4925, - "source_points": 4671 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7406388323962196, - "inlier_rmse_m": 0.2013390996172439, - "target_points": 8254, - "source_points": 8359 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6060325995630986, - "inlier_rmse_m": 0.1256580595071168, - "target_points": 11402, - "source_points": 11902 - } - ], - "heldout_symmetric": { - "evaluated": 7968, - "inliers": 4881, - "inlier_ratio": 0.6125753012048193, - "inlier_rmse_m": 0.12248054470736866, - "median_m": 0.16942717602777319, - "p90_m": 1.288389882081946, - "p95_m": 2.112459228542434 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4018.66586982947, - 5000.665808194096, - 6600.6710385773595, - 7213.000000000002, - 8785.22591761568, - 11456.468084290462 - ], - "effective_rank": 6, - "scaled_condition_number": 2.850813791288553, - "weakest_scaled_direction": [ - 0.13889128425343436, - 0.8861569775748834, - -0.009865528152038642, - -0.22559614846995144, - 0.03114174469929694, - -0.3787799666569873 - ] - }, - "forward_reverse": { - "translation_m": 0.006578056867618694, - "rotation_deg": 0.0648765356282168 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0175362097255202e-15, - "rotation_deg": 9.244505242989037e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 16041, - "frame_counter_j": 17319, - "rtk_translation_m": 8.48963239412477, - "rtk_rotation_deg": 1.7100498839998592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9972755589052105, - 0.0031159642573779906, - -0.07370040961247146, - 8.445881589438544 - ], - [ - -0.0030922793190987304, - 0.9999951240744098, - 0.00043547217840025524, - 0.16993751377088837 - ], - [ - 0.07370140717050119, - -0.00020638350764803342, - 0.997280331695625, - 0.28518388836519776 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6142, - "backend_objective": 106.20557248104443, - "backend_elapsed_sec": 0.21178530000179308, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7910482374768089, - "inlier_rmse_m": 0.4499127192272035, - "target_points": 4395, - "source_points": 4312 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6513066532003535, - "inlier_rmse_m": 0.2173501242239611, - "target_points": 7727, - "source_points": 7921 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5258111463059669, - "inlier_rmse_m": 0.13149787844424618, - "target_points": 11005, - "source_points": 11681 - } - ], - "heldout_symmetric": { - "evaluated": 8050, - "inliers": 4768, - "inlier_ratio": 0.5922981366459628, - "inlier_rmse_m": 0.1252332170275593, - "median_m": 0.17774715429472215, - "p90_m": 1.6358607338027042, - "p95_m": 2.905648836250951 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2877.740685215958, - 3789.319460018401, - 4687.361835944773, - 6141.9999999999945, - 8181.68610828966, - 10250.428097045908 - ], - "effective_rank": 6, - "scaled_condition_number": 3.561970732702301, - "weakest_scaled_direction": [ - -0.3351772978382878, - -0.7301654344140649, - 0.0088958922733919, - 0.106376134556787, - -0.05593519717556636, - -0.5830873452709213 - ] - }, - "forward_reverse": { - "translation_m": 0.0101884878590875, - "rotation_deg": 0.04905586883665525 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.9499359079002526e-15, - "rotation_deg": 1.518219923783034e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 16041, - "frame_counter_j": 19292, - "rtk_translation_m": 7.8510898708654135, - "rtk_rotation_deg": 30.258149796526293, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8790657883361814, - 0.47245082378952613, - -0.06351030528571952, - 7.661764680067065 - ], - [ - -0.47488711314023535, - 0.8795246853008348, - -0.030307717165776005, - -0.6886984397610693 - ], - [ - 0.0415399753276316, - 0.056802702814793334, - 0.9975208686552448, - 0.1737092444102929 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5832, - "backend_objective": 99.20523709733325, - "backend_elapsed_sec": 0.44527340000058757, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7741383001498608, - "inlier_rmse_m": 0.4552295041847101, - "target_points": 4395, - "source_points": 4671 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6305778203134346, - "inlier_rmse_m": 0.2192630857363722, - "target_points": 7727, - "source_points": 8359 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4900016803898504, - "inlier_rmse_m": 0.1304243082717224, - "target_points": 11005, - "source_points": 11902 - } - ], - "heldout_symmetric": { - "evaluated": 8092, - "inliers": 4484, - "inlier_ratio": 0.5541275333662877, - "inlier_rmse_m": 0.12481360204475032, - "median_m": 0.20088917540362328, - "p90_m": 1.6271437021122481, - "p95_m": 2.7877623710646944 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2582.7670144667895, - 3991.329749436857, - 4695.374817736162, - 5832.0, - 7526.473943626894, - 9689.972450830295 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7517795436266956, - "weakest_scaled_direction": [ - 0.44715545629674713, - 0.6920222871256623, - -0.000344467670909058, - -0.10444956831326907, - 0.067766079111135, - 0.5528608139202065 - ] - }, - "forward_reverse": { - "translation_m": 0.031261518480906504, - "rotation_deg": 0.2822575477830575 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.885124068817307e-15, - "rotation_deg": 5.0755418377926146e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 16041, - "frame_counter_j": 20886, - "rtk_translation_m": 7.303425556850936, - "rtk_rotation_deg": 93.89697482620899, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.02016869585605394, - 0.9970116910888586, - 0.07457151962781627, - 4.707594558870463 - ], - [ - -0.9992218092263088, - -0.01757218214589043, - -0.03531280760763063, - -5.4559742771613005 - ], - [ - -0.03389689770418346, - -0.07522570203572336, - 0.9965902337868177, - -0.1194320802858733 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5435, - "backend_objective": 94.18579789923616, - "backend_elapsed_sec": 0.28233000000182074, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7863527359930238, - "inlier_rmse_m": 0.46015137537469575, - "target_points": 4395, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6233235406820794, - "inlier_rmse_m": 0.21932133027221334, - "target_points": 7727, - "source_points": 7829 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4870508110045703, - "inlier_rmse_m": 0.13164153460710684, - "target_points": 11005, - "source_points": 11159 - } - ], - "heldout_symmetric": { - "evaluated": 7986, - "inliers": 3912, - "inlier_ratio": 0.4898572501878287, - "inlier_rmse_m": 0.1234709130125476, - "median_m": 0.26405262434028004, - "p90_m": 1.7529224192389614, - "p95_m": 2.5466212048170433 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2211.2919849388836, - 3098.960687948221, - 3763.508903704533, - 5435.0, - 9402.98872952444, - 11082.833709823906 - ], - "effective_rank": 6, - "scaled_condition_number": 5.011926866876523, - "weakest_scaled_direction": [ - 0.31837729857066316, - 0.8126164453732778, - 0.04089323403329819, - -0.16888822360852052, - 0.04331690518198797, - 0.45411294357885956 - ] - }, - "forward_reverse": { - "translation_m": 0.002887507644989318, - "rotation_deg": 0.12861291537137956 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.95090418262362e-16, - "rotation_deg": 5.7405969241296616e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 17319, - "frame_counter_j": 19292, - "rtk_translation_m": 0.684356309096518, - "rtk_rotation_deg": 28.54809991252644, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8814157857198027, - 0.4722562023151715, - 0.00896058361909999, - -0.7796716428767354 - ], - [ - -0.471897931956634, - 0.8812518227956767, - -0.02660012470553167, - -0.8779187735985932 - ], - [ - -0.0204586045221893, - 0.01921728893859314, - 0.9996059930326826, - -0.034742009284771565 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9220, - "backend_objective": 112.7385758007722, - "backend_elapsed_sec": 0.23917240000446327, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.938985228002569, - "inlier_rmse_m": 0.32499167711151794, - "target_points": 4312, - "source_points": 4671 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8633807871754995, - "inlier_rmse_m": 0.16697809094287208, - "target_points": 7921, - "source_points": 8359 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7746597210552848, - "inlier_rmse_m": 0.11057852982481836, - "target_points": 11681, - "source_points": 11902 - } - ], - "heldout_symmetric": { - "evaluated": 8182, - "inliers": 6573, - "inlier_ratio": 0.8033488144707895, - "inlier_rmse_m": 0.10033649821782255, - "median_m": 0.08051201689972302, - "p90_m": 0.5475316408696184, - "p95_m": 1.0381587439378135 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5250.989378105007, - 6244.28332169446, - 8067.0104155578565, - 9219.999999999998, - 11424.009524618414, - 14962.779189451943 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8495161791494152, - "weakest_scaled_direction": [ - -0.013541530797626607, - -0.8432778108162534, - -0.022673620232394234, - 0.19012487873901643, - -0.016544151044564453, - 0.5017607888474849 - ] - }, - "forward_reverse": { - "translation_m": 0.0037957676909615035, - "rotation_deg": 0.030493386938618566 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.959875457518964e-15, - "rotation_deg": 1.0815671934685811e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 17319, - "frame_counter_j": 20886, - "rtk_translation_m": 4.983180422136547, - "rtk_rotation_deg": 92.18692494220912, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.019611736124146704, - 0.9884463771871549, - 0.15029683706512806, - -3.7415079476882926 - ], - [ - -0.9993551176581625, - -0.014857628395836325, - -0.03268944308016967, - -5.6324048544407095 - ], - [ - -0.0300787070306763, - -0.15084101002060432, - 0.9881003294601839, - -0.09826795452365211 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5312, - "backend_objective": 92.89963975161197, - "backend_elapsed_sec": 0.41592550000495976, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.775452365380423, - "inlier_rmse_m": 0.488279590163271, - "target_points": 4312, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5915187124792438, - "inlier_rmse_m": 0.21182953041733482, - "target_points": 7921, - "source_points": 7829 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.47602831794963707, - "inlier_rmse_m": 0.13224461048161085, - "target_points": 11681, - "source_points": 11159 - } - ], - "heldout_symmetric": { - "evaluated": 8076, - "inliers": 3954, - "inlier_ratio": 0.48959881129271915, - "inlier_rmse_m": 0.13002768142853224, - "median_m": 0.26087495554624374, - "p90_m": 1.5882172678918716, - "p95_m": 2.348593871839569 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1781.688788896248, - 2602.39170919365, - 3064.1350465850123, - 5311.999999999999, - 11423.388610073374, - 13363.993245201933 - ], - "effective_rank": 6, - "scaled_condition_number": 7.500744983348576, - "weakest_scaled_direction": [ - 0.12945121331652676, - -0.6213236092288341, - -0.039239453105174134, - 0.16323337808599142, - -0.013622418129876938, - 0.7542074749753359 - ] - }, - "forward_reverse": { - "translation_m": 0.04820000634069387, - "rotation_deg": 0.21663658694591276 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.611021474463186e-15, - "rotation_deg": 4.862939515412945e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 17319, - "frame_counter_j": 22408, - "rtk_translation_m": 7.513058208926106, - "rtk_rotation_deg": 116.17598776756182, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4697311157510372, - 0.8780360092826386, - 0.0916812156240502, - -4.917910379456156 - ], - [ - -0.8827683720909915, - -0.4681722926748111, - -0.039175318855513855, - -8.045112773790304 - ], - [ - 0.008525264283655042, - -0.09933514370366917, - 0.9950175119535662, - -0.020332201823427716 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6343, - "backend_objective": 121.2883371634163, - "backend_elapsed_sec": 0.3965100000059465, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7773958754549131, - "inlier_rmse_m": 0.4534567059875387, - "target_points": 4312, - "source_points": 4946 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6297907359510934, - "inlier_rmse_m": 0.20328108657554372, - "target_points": 7921, - "source_points": 8506 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5274844074844075, - "inlier_rmse_m": 0.13828088975563133, - "target_points": 11681, - "source_points": 12025 - } - ], - "heldout_symmetric": { - "evaluated": 8181, - "inliers": 4509, - "inlier_ratio": 0.5511551155115512, - "inlier_rmse_m": 0.1363490361205856, - "median_m": 0.21439916153668448, - "p90_m": 1.5236925857497872, - "p95_m": 2.528026452320966 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1905.0755666771752, - 2700.278509348906, - 3189.9747926062096, - 6343.0, - 14508.838771951723, - 16558.53034338216 - ], - "effective_rank": 6, - "scaled_condition_number": 8.69179713026475, - "weakest_scaled_direction": [ - 0.35484728803187143, - -0.4763675347315304, - -0.03901458048231779, - 0.11227445168063323, - 0.018488734326470174, - 0.7954167780119032 - ] - }, - "forward_reverse": { - "translation_m": 0.020420243910966678, - "rotation_deg": 0.3388561639372597 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.448481638694843e-15, - "rotation_deg": 4.09977787547746e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 19292, - "frame_counter_j": 20886, - "rtk_translation_m": 4.470221622128888, - "rtk_rotation_deg": 63.638825029682685, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4550295855525637, - 0.8813842829786904, - 0.12692447356597628, - -0.3598104983059777 - ], - [ - -0.8904697703633423, - 0.450926957931257, - 0.0610611716225598, - -5.591677621336949 - ], - [ - -0.003415309783743225, - -0.14080704644655037, - 0.9900311668478319, - 0.05054804258115641 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6073, - "backend_objective": 108.32870401711395, - "backend_elapsed_sec": 0.47188090000418015, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8225419664268585, - "inlier_rmse_m": 0.4336806648879573, - "target_points": 4671, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.67965257376421, - "inlier_rmse_m": 0.21205847247555482, - "target_points": 8359, - "source_points": 7829 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5442243928667443, - "inlier_rmse_m": 0.1335580695720798, - "target_points": 11902, - "source_points": 11159 - } - ], - "heldout_symmetric": { - "evaluated": 8118, - "inliers": 4452, - "inlier_ratio": 0.5484109386548411, - "inlier_rmse_m": 0.12959344453923985, - "median_m": 0.21160987047704477, - "p90_m": 1.3367699400261084, - "p95_m": 2.2078289041331023 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2240.9036901422965, - 3547.5985547926016, - 4275.402367863059, - 6073.0, - 11560.601823644078, - 14124.715182518832 - ], - "effective_rank": 6, - "scaled_condition_number": 6.303133528073185, - "weakest_scaled_direction": [ - -0.34195281944223704, - 0.615638538849221, - 0.019075978366876238, - -0.16811524996095065, - -0.07213076766451976, - -0.6857317120384192 - ] - }, - "forward_reverse": { - "translation_m": 0.011857268436770598, - "rotation_deg": 0.07665557322523474 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.6420733473050495e-15, - "rotation_deg": 3.065578290797877e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 19292, - "frame_counter_j": 22408, - "rtk_translation_m": 7.042432348069883, - "rtk_rotation_deg": 87.62788785503537, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.002278158454854553, - 0.996636344936312, - 0.08191950894653019, - -0.2670129008414705 - ], - [ - -0.9997108810611978, - 0.0003089602333698444, - 0.024042854061403284, - -8.261220815767517 - ], - [ - 0.0239366723229925, - -0.0819505978962952, - 0.9963489023542612, - 0.18589798124965734 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6818, - "backend_objective": 123.47145746254824, - "backend_elapsed_sec": 0.6952197000064189, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.810351799433886, - "inlier_rmse_m": 0.41517541429785076, - "target_points": 4671, - "source_points": 4946 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6806959793087233, - "inlier_rmse_m": 0.20348588940658907, - "target_points": 8359, - "source_points": 8506 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.566985446985447, - "inlier_rmse_m": 0.13457202539151375, - "target_points": 11902, - "source_points": 12025 - } - ], - "heldout_symmetric": { - "evaluated": 8223, - "inliers": 4789, - "inlier_ratio": 0.5823908549191292, - "inlier_rmse_m": 0.13141832933236727, - "median_m": 0.18989401643022658, - "p90_m": 1.4717686918981643, - "p95_m": 2.4154325832374735 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2259.8668638528784, - 3291.8560870728147, - 3829.774007601829, - 6818.000000000001, - 14384.371075044046, - 16670.960516636445 - ], - "effective_rank": 6, - "scaled_condition_number": 7.376965777627224, - "weakest_scaled_direction": [ - 0.4095880266720199, - -0.5361733872429939, - -0.03357835346713654, - 0.14238196951283943, - 0.06363691303658311, - 0.7206288638783144 - ] - }, - "forward_reverse": { - "translation_m": 0.010833935971029728, - "rotation_deg": 0.22584716035991784 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.767435846609437e-15, - "rotation_deg": 1.1410309218263422e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 19292, - "frame_counter_j": 23318, - "rtk_translation_m": 9.425648786798952, - "rtk_rotation_deg": 64.11974003309916, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.43776796892387726, - 0.8943291354552259, - 0.09238291433035367, - 0.7178641038763979 - ], - [ - -0.899079672274981, - 0.4358887062032488, - 0.04070354660677306, - -10.43314499439954 - ], - [ - -0.003866301355946555, - -0.10087830926598775, - 0.9948912596025066, - 0.2683136064600935 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5751, - "backend_objective": 110.97935132682835, - "backend_elapsed_sec": 0.6214773000028799, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.757525430766037, - "inlier_rmse_m": 0.45311878963530766, - "target_points": 4671, - "source_points": 4817 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.612895493767977, - "inlier_rmse_m": 0.21379048508528392, - "target_points": 8359, - "source_points": 8344 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.48733158206931615, - "inlier_rmse_m": 0.1389150844322096, - "target_points": 11902, - "source_points": 11801 - } - ], - "heldout_symmetric": { - "evaluated": 8141, - "inliers": 4187, - "inlier_ratio": 0.5143102812922246, - "inlier_rmse_m": 0.13728792513153318, - "median_m": 0.23684561373177704, - "p90_m": 1.7635278352588482, - "p95_m": 2.78267378610419 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1555.3087627141617, - 2462.131308633848, - 3257.578206700475, - 5750.999999999998, - 14449.34255169944, - 16588.473965605015 - ], - "effective_rank": 6, - "scaled_condition_number": 10.6657111200586, - "weakest_scaled_direction": [ - 0.44664164801947154, - -0.4286190712139463, - -0.027149142630396424, - 0.12236379508338298, - 0.0786541996654089, - 0.771297914316099 - ] - }, - "forward_reverse": { - "translation_m": 0.012453922151317217, - "rotation_deg": 0.21281971313986298 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.063799849278554e-15, - "rotation_deg": 6.095390297845445e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 20886, - "frame_counter_j": 22408, - "rtk_translation_m": 2.6059162757855927, - "rtk_rotation_deg": 23.989062825352686, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8911842982319107, - 0.4534381180203288, - 0.013580121909536447, - 2.4209865139968945 - ], - [ - -0.45192820519098953, - 0.8900199873037506, - -0.06021062657605138, - -1.1369047023979102 - ], - [ - -0.03938837312897866, - 0.04752152487043019, - 0.9980933126397764, - -0.01831899825070699 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7754, - "backend_objective": 127.19936318169057, - "backend_elapsed_sec": 0.7470931999996537, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9098261221188839, - "inlier_rmse_m": 0.39080334012905016, - "target_points": 4587, - "source_points": 4946 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7825064660239831, - "inlier_rmse_m": 0.2019005357012036, - "target_points": 7829, - "source_points": 8506 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6448232848232848, - "inlier_rmse_m": 0.1280794842751811, - "target_points": 11159, - "source_points": 12025 - } - ], - "heldout_symmetric": { - "evaluated": 8117, - "inliers": 5397, - "inlier_ratio": 0.6649008254281138, - "inlier_rmse_m": 0.11829356218038511, - "median_m": 0.14483320833928243, - "p90_m": 0.9080229648023326, - "p95_m": 1.2571629256935462 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3277.140262080254, - 6441.221544181387, - 7754.0, - 7977.808590112464, - 10511.220670400226, - 14647.2921283672 - ], - "effective_rank": 6, - "scaled_condition_number": 4.46953470312236, - "weakest_scaled_direction": [ - 0.8618302247087118, - 0.04075452151598702, - -0.020909020273045045, - 0.004737835516798932, - 0.14763465987367463, - 0.48304462086266514 - ] - }, - "forward_reverse": { - "translation_m": 0.010710695211339957, - "rotation_deg": 0.05103080008067046 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.826119183717024e-15, - "rotation_deg": 6.90153787542698e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 20886, - "frame_counter_j": 23318, - "rtk_translation_m": 4.985522367267706, - "rtk_rotation_deg": 0.4809150034164723, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9998065256728996, - 0.019446647499204783, - 0.0029562007589723407, - 4.823805046088721 - ], - [ - -0.019301775946337193, - 0.9988900056367624, - -0.042967407232783486, - -1.2579796841031243 - ], - [ - -0.0037884914152040007, - 0.04290203421787979, - 0.9990721008980109, - 0.037976795821106614 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7455, - "backend_objective": 123.6132162284606, - "backend_elapsed_sec": 0.35901210000156425, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8851982561760432, - "inlier_rmse_m": 0.41143606014563755, - "target_points": 4587, - "source_points": 4817 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7563518696069031, - "inlier_rmse_m": 0.20452938889436686, - "target_points": 7829, - "source_points": 8344 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6317261249046691, - "inlier_rmse_m": 0.12876820128341213, - "target_points": 11159, - "source_points": 11801 - } - ], - "heldout_symmetric": { - "evaluated": 8035, - "inliers": 5169, - "inlier_ratio": 0.6433105164903546, - "inlier_rmse_m": 0.12280456147298241, - "median_m": 0.15828943169228152, - "p90_m": 1.0186950960935366, - "p95_m": 1.453317514997252 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2866.07826217154, - 5245.94834201071, - 6313.996252318294, - 7454.999999999999, - 12394.493548638138, - 15712.205462191374 - ], - "effective_rank": 6, - "scaled_condition_number": 5.48212715248282, - "weakest_scaled_direction": [ - 0.7956996515452667, - 0.1598880967473577, - -0.01384627692967756, - -0.01692151710655989, - 0.13343025263231562, - 0.5683451166375271 - ] - }, - "forward_reverse": { - "translation_m": 0.002079348825514708, - "rotation_deg": 0.08095419399489742 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.938931151522513e-15, - "rotation_deg": 5.664125586621537e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 20886, - "frame_counter_j": 24870, - "rtk_translation_m": 5.330126890587504, - "rtk_rotation_deg": 0.570225046299944, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999801280322911, - -0.0026168395094042477, - 0.005735476571355017, - -5.352408498345026 - ], - [ - 0.003019393963080107, - 0.9974474207730923, - -0.07134091430029454, - -0.3809551677045818 - ], - [ - -0.005534148589824523, - 0.0713568142792842, - 0.9974355007995724, - -0.0917480053440553 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5673, - "backend_objective": 99.86164920929278, - "backend_elapsed_sec": 0.473786000002292, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.800404131118096, - "inlier_rmse_m": 0.4472094370463477, - "target_points": 4587, - "source_points": 4454 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6219099008658552, - "inlier_rmse_m": 0.2142268504684041, - "target_points": 7829, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.49214886787542295, - "inlier_rmse_m": 0.1326761850159431, - "target_points": 11159, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 7978, - "inliers": 4063, - "inlier_ratio": 0.5092755076460266, - "inlier_rmse_m": 0.12767535698436475, - "median_m": 0.23902484579332356, - "p90_m": 2.583304846769688, - "p95_m": 4.827717618426238 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2337.957305823871, - 3119.5585581916894, - 3687.686127196108, - 5673.000000000001, - 9900.616103846622, - 11976.852908110563 - ], - "effective_rank": 6, - "scaled_condition_number": 5.1227851245513, - "weakest_scaled_direction": [ - -0.15932581342480445, - 0.6452688711737181, - 0.026459443407927396, - -0.11143487094879508, - 0.002760262686342764, - -0.7383210124409236 - ] - }, - "forward_reverse": { - "translation_m": 0.01771530501608281, - "rotation_deg": 0.1987385247368959 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.808701060135193e-15, - "rotation_deg": 2.6238767175322306e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 22408, - "frame_counter_j": 23318, - "rtk_translation_m": 2.3845573265941185, - "rtk_rotation_deg": 23.508147821936216, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8998338507034729, - -0.43608007714873076, - -0.011541552846903976, - 2.189822307200267 - ], - [ - 0.43618615732086163, - 0.899809530217102, - 0.009189422840367957, - 0.9890807010137211 - ], - [ - 0.006377875023968559, - -0.01330321932599743, - 0.9998911676106274, - 0.08392851469665327 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9045, - "backend_objective": 126.04593808455687, - "backend_elapsed_sec": 0.2811599000051501, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.952044841187461, - "inlier_rmse_m": 0.31704528079398275, - "target_points": 4946, - "source_points": 4817 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8716442953020134, - "inlier_rmse_m": 0.1774474655680828, - "target_points": 8506, - "source_points": 8344 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7664604694517414, - "inlier_rmse_m": 0.11804840996869355, - "target_points": 12025, - "source_points": 11801 - } - ], - "heldout_symmetric": { - "evaluated": 8140, - "inliers": 6459, - "inlier_ratio": 0.7934889434889435, - "inlier_rmse_m": 0.10996554201681306, - "median_m": 0.10243053348443153, - "p90_m": 0.49990834345661517, - "p95_m": 0.843791191193474 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4132.969068772384, - 7499.697979715452, - 8521.449918868851, - 9045.0, - 11307.112016027662, - 14869.757534910128 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5978390564938083, - "weakest_scaled_direction": [ - 0.7883368516256851, - 0.5043806732595225, - -0.005164611401898622, - -0.0876827538487322, - 0.1402312708785061, - 0.3110392209119979 - ] - }, - "forward_reverse": { - "translation_m": 0.010537581931095797, - "rotation_deg": 0.18886023198851049 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8199241385860823e-15, - "rotation_deg": 2.122366991371905e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 22408, - "frame_counter_j": 24870, - "rtk_translation_m": 7.871327660405588, - "rtk_rotation_deg": 24.55928787165262, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8897853035933652, - -0.45637894568667114, - 0.0006094613892899427, - -7.2818170831578035 - ], - [ - 0.45632588065643614, - 0.8896598160571842, - -0.016495524733280906, - -2.857918897382133 - ], - [ - 0.006985996878833494, - 0.014955588487928028, - 0.999863753828784, - -0.23478601776779398 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5983, - "backend_objective": 104.78140626235712, - "backend_elapsed_sec": 0.6640823999987333, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8114054782218231, - "inlier_rmse_m": 0.42829935020178456, - "target_points": 4946, - "source_points": 4454 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6611871000125487, - "inlier_rmse_m": 0.2122481253801519, - "target_points": 8506, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5190422486336428, - "inlier_rmse_m": 0.13233740367292376, - "target_points": 12025, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 8083, - "inliers": 4142, - "inlier_ratio": 0.5124335024124707, - "inlier_rmse_m": 0.1271130929550258, - "median_m": 0.23675773642822143, - "p90_m": 2.5880962260865723, - "p95_m": 4.620927048089595 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2087.1120252440182, - 3128.286096342291, - 3652.1096027253125, - 5982.999999999997, - 11881.943155584519, - 14136.10633410681 - ], - "effective_rank": 6, - "scaled_condition_number": 6.773046277884419, - "weakest_scaled_direction": [ - -0.14825147986824824, - 0.6428073075399467, - 0.023718539501503513, - -0.09490148657083465, - 0.005606858152287084, - -0.7451308381501469 - ] - }, - "forward_reverse": { - "translation_m": 0.0367675981786339, - "rotation_deg": 0.17067950171934768 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.165824317101817e-15, - "rotation_deg": 2.1261657270316395e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 22408, - "frame_counter_j": 26309, - "rtk_translation_m": 6.334147330965719, - "rtk_rotation_deg": 0.13339551798522414, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9994244591283789, - -0.033903716849653535, - -0.0011351122081183546, - -5.631820923080135 - ], - [ - 0.03389808827786833, - 0.999414446045704, - -0.004656677599385074, - -2.897257254696088 - ], - [ - 0.0012923262174659984, - 0.004615519357264588, - 0.9999885133710338, - -0.1811862593291872 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6754, - "backend_objective": 106.81524747164349, - "backend_elapsed_sec": 0.356680700002471, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8572032108153781, - "inlier_rmse_m": 0.4262704840618885, - "target_points": 4946, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7090540379339139, - "inlier_rmse_m": 0.20625895912343398, - "target_points": 8506, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5705355634397702, - "inlier_rmse_m": 0.12575813767050187, - "target_points": 12025, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 8094, - "inliers": 4854, - "inlier_ratio": 0.5997034840622684, - "inlier_rmse_m": 0.12123178848040567, - "median_m": 0.17047223001780792, - "p90_m": 1.51026040763687, - "p95_m": 2.4450182166425725 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2827.6505236241433, - 3550.181315773982, - 4173.350696850004, - 6754.0, - 11976.98404284756, - 14285.720618010373 - ], - "effective_rank": 6, - "scaled_condition_number": 5.0521521307734485, - "weakest_scaled_direction": [ - 0.40986462595273243, - -0.5117564168085849, - -0.008156320034195244, - 0.07452417693381386, - 0.047735838044947076, - 0.7498114893157141 - ] - }, - "forward_reverse": { - "translation_m": 0.007039639082169618, - "rotation_deg": 0.1420706023439064 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.6564062659857655e-15, - "rotation_deg": 2.1832922379840623e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 23318, - "frame_counter_j": 24870, - "rtk_translation_m": 10.188241681839806, - "rtk_rotation_deg": 1.051140049716416, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9997480885811247, - -0.02244065217888664, - -0.00042012875852952096, - -10.188142516446552 - ], - [ - 0.022417248158511604, - 0.9992790613460518, - -0.030640243803782764, - 0.6776553238945129 - ], - [ - 0.001107412925344839, - 0.030623107045853002, - 0.9995303892085878, - -0.21173060573998825 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5468, - "backend_objective": 103.78878798792496, - "backend_elapsed_sec": 0.40377319999970496, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8037718904355635, - "inlier_rmse_m": 0.4590530633267239, - "target_points": 4817, - "source_points": 4454 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6330781779395156, - "inlier_rmse_m": 0.2267075464803671, - "target_points": 8344, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.47436453543853563, - "inlier_rmse_m": 0.1377720013562404, - "target_points": 11801, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 8001, - "inliers": 3621, - "inlier_ratio": 0.4525684289463817, - "inlier_rmse_m": 0.1310762605599437, - "median_m": 0.31506577479623904, - "p90_m": 3.2839498925379362, - "p95_m": 5.83252592295288 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1479.9674409915342, - 2413.9040518435454, - 3298.9488265114646, - 5468.000000000001, - 12839.074924602328, - 15038.294870975662 - ], - "effective_rank": 6, - "scaled_condition_number": 10.161233588287896, - "weakest_scaled_direction": [ - -0.10087052190126221, - -0.5991162124729152, - -0.016175135323276316, - 0.06343996398802826, - -0.03203492661872272, - 0.7909313505017239 - ] - }, - "forward_reverse": { - "translation_m": 0.03028489261617412, - "rotation_deg": 0.2306307424740811 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.5854949631290474e-15, - "rotation_deg": 1.3883320192939354e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 23318, - "frame_counter_j": 26309, - "rtk_translation_m": 8.639041695194567, - "rtk_rotation_deg": 23.641543339921444, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9140785326446205, - 0.4054355423929579, - 0.009080590442460831, - -8.741380234882769 - ], - [ - -0.4052546532275878, - 0.9140483438013033, - -0.0168609380368546, - -0.08215667419258207 - ], - [ - -0.015136122212895486, - 0.011732269968878719, - 0.999816609006738, - -0.1977576927661062 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6216, - "backend_objective": 110.88029277834167, - "backend_elapsed_sec": 0.5276767000032123, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8386142796789184, - "inlier_rmse_m": 0.4464076684130243, - "target_points": 4817, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6769652868901348, - "inlier_rmse_m": 0.2133847189449056, - "target_points": 8344, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5250886974151039, - "inlier_rmse_m": 0.13355854498533837, - "target_points": 11801, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 8012, - "inliers": 4342, - "inlier_ratio": 0.5419370943584623, - "inlier_rmse_m": 0.12926666329467473, - "median_m": 0.21152565676211282, - "p90_m": 1.7607738258512409, - "p95_m": 3.0294872930971444 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2235.5036821209687, - 3066.41377214912, - 3514.4431064375776, - 6215.999999999998, - 13613.77567315688, - 15918.776735296418 - ], - "effective_rank": 6, - "scaled_condition_number": 7.1208904116826295, - "weakest_scaled_direction": [ - -0.06113014840375785, - 0.5899716703098873, - 0.012404062956818751, - -0.07316897032825197, - 0.009272614183356084, - -0.8016252196739877 - ] - }, - "forward_reverse": { - "translation_m": 0.016749087599431237, - "rotation_deg": 0.21516518274709787 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.3306690738754696e-16, - "rotation_deg": 8.073971199735778e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 23318, - "frame_counter_j": 27507, - "rtk_translation_m": 9.620687246763701, - "rtk_rotation_deg": 76.25281000098852, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2311125472235199, - 0.9728651254188304, - -0.01097443664432408, - -10.551533108681642 - ], - [ - -0.9724038583152612, - 0.23060371777814898, - -0.035392960888997196, - -0.6815346714943525 - ], - [ - -0.031901831443516125, - 0.01885134188061571, - 0.999313214192552, - -0.2405354464025625 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5758, - "backend_objective": 107.62982372756119, - "backend_elapsed_sec": 0.43881530000362545, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8317695832424177, - "inlier_rmse_m": 0.4571230379943217, - "target_points": 4817, - "source_points": 4583 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6505979533966219, - "inlier_rmse_m": 0.22523499352119764, - "target_points": 8344, - "source_points": 8111 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4945460791892124, - "inlier_rmse_m": 0.13671950717240752, - "target_points": 11801, - "source_points": 11643 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 4124, - "inlier_ratio": 0.5239486723415068, - "inlier_rmse_m": 0.13468232645821807, - "median_m": 0.2312693659438064, - "p90_m": 1.7565535091459323, - "p95_m": 3.1507038732352064 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1990.9568191552423, - 2809.462454318739, - 3378.783470064795, - 5757.999999999997, - 13184.611191141756, - 15461.230421789294 - ], - "effective_rank": 6, - "scaled_condition_number": 7.765728655204814, - "weakest_scaled_direction": [ - 0.01217519673601595, - 0.5864425173365684, - 0.02042032238291746, - -0.06910694091579456, - 0.029505330344275507, - -0.806147390417349 - ] - }, - "forward_reverse": { - "translation_m": 0.015824236097669597, - "rotation_deg": 0.5418501890608881 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2826762290599817e-15, - "rotation_deg": 1.2512675348933264e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 24870, - "frame_counter_j": 26309, - "rtk_translation_m": 1.5531467972267479, - "rtk_rotation_deg": 24.69268338963786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9046948432217068, - 0.4259894535755002, - 0.007760547048704878, - 1.4309634989804343 - ], - [ - -0.4260589942263698, - 0.9045845204247275, - 0.014162586161428015, - -0.7924740051161993 - ], - [ - -0.0009869583901635753, - -0.0161192695371447, - 0.9998695890278513, - 0.049381524178047746 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8267, - "backend_objective": 121.22871456044957, - "backend_elapsed_sec": 0.7353098999956273, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8662864385297845, - "inlier_rmse_m": 0.30838921447673473, - "target_points": 4454, - "source_points": 4734 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8191578193963974, - "inlier_rmse_m": 0.18452339191643846, - "target_points": 7969, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6983443149180605, - "inlier_rmse_m": 0.12109571652555767, - "target_points": 11527, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 7955, - "inliers": 5771, - "inlier_ratio": 0.725455688246386, - "inlier_rmse_m": 0.11626130134637655, - "median_m": 0.12549675750266034, - "p90_m": 1.2822739658556164, - "p95_m": 2.59351256878102 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4030.887837976205, - 4672.750808635114, - 7330.093237506429, - 8267.000000000002, - 8961.203522921793, - 10294.610417800104 - ], - "effective_rank": 6, - "scaled_condition_number": 2.5539312507809044, - "weakest_scaled_direction": [ - 0.2887584510735914, - 0.9408637848748305, - -0.0039099798166485605, - -0.16279357111524712, - 0.0501645208418132, - 0.04858375607833474 - ] - }, - "forward_reverse": { - "translation_m": 0.008173066808338859, - "rotation_deg": 0.1459219364983215 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.290111878070832e-15, - "rotation_deg": 1.5010150086388822e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 24870, - "frame_counter_j": 27507, - "rtk_translation_m": 0.5677742310084086, - "rtk_rotation_deg": 77.30395005070493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2093387871705725, - 0.9778398081063578, - -0.0025655152453282915, - -0.40822595310934207 - ], - [ - -0.97782635470461, - 0.20931907803485686, - -0.006414328938609716, - -1.3506115603542925 - ], - [ - -0.005735174892624682, - 0.0038513962608001345, - 0.9999761369731752, - 0.01291982502540542 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8557, - "backend_objective": 125.58185458109693, - "backend_elapsed_sec": 0.608847200004675, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8686449923630809, - "inlier_rmse_m": 0.2972846263440513, - "target_points": 4454, - "source_points": 4583 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.824189372457157, - "inlier_rmse_m": 0.1765081556795439, - "target_points": 7969, - "source_points": 8111 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7349480374473932, - "inlier_rmse_m": 0.1211442150271022, - "target_points": 11527, - "source_points": 11643 - } - ], - "heldout_symmetric": { - "evaluated": 7814, - "inliers": 5868, - "inlier_ratio": 0.7509598157153826, - "inlier_rmse_m": 0.11215936550371307, - "median_m": 0.11455146689268958, - "p90_m": 1.2434092826934635, - "p95_m": 2.5763133788976864 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4150.808280996938, - 5183.907860505661, - 7524.9113312056, - 8556.999999999998, - 9561.21683074907, - 11329.98221303939 - ], - "effective_rank": 6, - "scaled_condition_number": 2.72958456426664, - "weakest_scaled_direction": [ - 0.6692222759859566, - 0.7156139150476367, - 0.022963768451750785, - -0.11713156473026726, - 0.10565710986478541, - 0.12094505749192504 - ] - }, - "forward_reverse": { - "translation_m": 0.01007065253007885, - "rotation_deg": 0.024451533638690782 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1648570564636616e-15, - "rotation_deg": 2.06995705001373e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 24870, - "frame_counter_j": 28833, - "rtk_translation_m": 2.9811390265794215, - "rtk_rotation_deg": 109.91770005034847, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3515990913554793, - 0.9360246918232635, - -0.015357579730100207, - -2.0680698696242548 - ], - [ - -0.935263824185193, - -0.351932644619401, - -0.03774907709708607, - -4.221562856822767 - ], - [ - -0.04073890190578004, - 0.0010908475417591428, - 0.9991692308729049, - -0.03872462414915298 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7010, - "backend_objective": 97.06825056108576, - "backend_elapsed_sec": 0.3300392999954056, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8063806380638063, - "inlier_rmse_m": 0.41360829122821663, - "target_points": 4454, - "source_points": 4545 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7139856683963429, - "inlier_rmse_m": 0.18919702727398366, - "target_points": 7969, - "source_points": 8094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6177844364149114, - "inlier_rmse_m": 0.11767374962010686, - "target_points": 11527, - "source_points": 11347 - } - ], - "heldout_symmetric": { - "evaluated": 8000, - "inliers": 4938, - "inlier_ratio": 0.61725, - "inlier_rmse_m": 0.11278472852394253, - "median_m": 0.14907839126209704, - "p90_m": 1.7568246353542838, - "p95_m": 2.742891122935363 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2799.3408480252265, - 3418.7156429246315, - 4746.562920355456, - 7010.0, - 9305.356842297251, - 10762.323873443947 - ], - "effective_rank": 6, - "scaled_condition_number": 3.8445921585562353, - "weakest_scaled_direction": [ - 0.7993901438338181, - 0.4339421784171822, - 0.04699383383516137, - -0.07609055164350977, - 0.0975126219496877, - 0.3939069431026253 - ] - }, - "forward_reverse": { - "translation_m": 0.013911959588582991, - "rotation_deg": 0.09838261866068182 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.036586047343041e-15, - "rotation_deg": 2.3747794089342974e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 26309, - "frame_counter_j": 27507, - "rtk_translation_m": 0.98603936348044, - "rtk_rotation_deg": 52.61126666106708, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6057936527913134, - 0.7956016417989944, - -0.005663727085858021, - -1.4238475228017977 - ], - [ - -0.7954937881833971, - 0.6055531428848185, - -0.022249137150656885, - -1.2908783465759166 - ], - [ - -0.014271762308390426, - 0.01798384578071746, - 0.9997364143070647, - -0.03716188170200044 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9144, - "backend_objective": 123.20274483583444, - "backend_elapsed_sec": 0.7620655999999144, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9591970325114554, - "inlier_rmse_m": 0.29018195822279996, - "target_points": 4734, - "source_points": 4583 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8976698310935767, - "inlier_rmse_m": 0.17832758852645283, - "target_points": 8383, - "source_points": 8111 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7853645967534141, - "inlier_rmse_m": 0.11607590626145285, - "target_points": 11838, - "source_points": 11643 - } - ], - "heldout_symmetric": { - "evaluated": 7825, - "inliers": 6210, - "inlier_ratio": 0.7936102236421725, - "inlier_rmse_m": 0.10947670477666799, - "median_m": 0.10527111253587526, - "p90_m": 0.473304453459665, - "p95_m": 0.7375041795246037 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4784.875423878792, - 6835.4984030624155, - 8466.690612751383, - 9144.000000000002, - 10965.958242811832, - 14169.657624553338 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9613430589728713, - "weakest_scaled_direction": [ - 0.7447022085970884, - 0.6070282520419868, - 0.025026077221867157, - -0.1189188248620497, - 0.13730944714826723, - 0.20811882665828263 - ] - }, - "forward_reverse": { - "translation_m": 0.004348617987976676, - "rotation_deg": 0.08578297576648478 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.293597077122223e-15, - "rotation_deg": 2.168564903853954e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 26309, - "frame_counter_j": 28833, - "rtk_translation_m": 3.326868398717413, - "rtk_rotation_deg": 85.22501666071064, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.08040116721665244, - 0.9967615498133261, - 0.0014370539087267449, - -1.7142537663000739 - ], - [ - -0.9953511215244761, - 0.08036392938937631, - -0.05308280072742902, - -4.600213190812497 - ], - [ - -0.05302638202035374, - 0.0028375459178719515, - 0.9985890802241909, - -0.12073647444377952 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7294, - "backend_objective": 102.06770836405266, - "backend_elapsed_sec": 0.36308850000204984, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8422442244224423, - "inlier_rmse_m": 0.3782239233275445, - "target_points": 4734, - "source_points": 4545 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7682233753397578, - "inlier_rmse_m": 0.19330630336480392, - "target_points": 8383, - "source_points": 8094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6428130783466995, - "inlier_rmse_m": 0.11829361464468424, - "target_points": 11838, - "source_points": 11347 - } - ], - "heldout_symmetric": { - "evaluated": 8011, - "inliers": 5318, - "inlier_ratio": 0.6638372238172513, - "inlier_rmse_m": 0.11457050422944211, - "median_m": 0.136449773635171, - "p90_m": 1.2037698510438133, - "p95_m": 1.894500434395174 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2881.69209222993, - 4332.588727262439, - 5372.167830399345, - 7293.999999999999, - 9752.917067835335, - 11639.304991972502 - ], - "effective_rank": 6, - "scaled_condition_number": 4.039052271877423, - "weakest_scaled_direction": [ - 0.7652939046481619, - 0.48073620254466665, - 0.03155489914278016, - -0.07366108130062399, - 0.09030747448629468, - 0.41065902713190483 - ] - }, - "forward_reverse": { - "translation_m": 0.011384309901198326, - "rotation_deg": 0.08601325248059774 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.579448339441587e-15, - "rotation_deg": 2.0620895538361244e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 26309, - "frame_counter_j": 31809, - "rtk_translation_m": 1.702964560097507, - "rtk_rotation_deg": 146.95247656520317, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8390847389647029, - 0.5419075400353404, - -0.0476761878654627, - -3.413343985290535 - ], - [ - -0.5405835360701935, - -0.8404133529040118, - -0.03840360387365798, - -2.0509212454204393 - ], - [ - -0.06087890740136073, - -0.006450915708973511, - 0.9981243130593165, - -0.13420885035368507 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7740, - "backend_objective": 111.54127448644651, - "backend_elapsed_sec": 0.3075900999974692, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8759537824286026, - "inlier_rmse_m": 0.38690172661065164, - "target_points": 4734, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7571168988491823, - "inlier_rmse_m": 0.19237829509436324, - "target_points": 8383, - "source_points": 8255 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.655376799322608, - "inlier_rmse_m": 0.12004589695408122, - "target_points": 11838, - "source_points": 11810 - } - ], - "heldout_symmetric": { - "evaluated": 7919, - "inliers": 5350, - "inlier_ratio": 0.6755903523172118, - "inlier_rmse_m": 0.11461754659819628, - "median_m": 0.13230063687603372, - "p90_m": 1.0623959834559191, - "p95_m": 1.5888315565676931 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4050.6674477409497, - 4669.235979684824, - 6456.507128839994, - 7740.0, - 9737.907663588858, - 12059.300897539022 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9771145257220444, - "weakest_scaled_direction": [ - 0.8251544084157371, - 0.4304807721678718, - 0.07147256683266459, - -0.11220995873552612, - 0.16564741733469207, - 0.2977717876950335 - ] - }, - "forward_reverse": { - "translation_m": 0.003070224389531284, - "rotation_deg": 0.041777705584758074 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.774360565568047e-15, - "rotation_deg": 3.015357452497299e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 27507, - "frame_counter_j": 28833, - "rtk_translation_m": 3.0423123591285863, - "rtk_rotation_deg": 32.61374999964355, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8410146529431494, - 0.540222899957811, - 0.029215952767049816, - 2.4587310741857524 - ], - [ - -0.5400433681218948, - 0.8415139778793554, - -0.014400888209488052, - -2.2331775975882526 - ], - [ - -0.03236532222103341, - -0.0036665235356321134, - 0.9994693804828116, - -0.00842559205637624 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8528, - "backend_objective": 110.38231335428645, - "backend_elapsed_sec": 0.5322851000019, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8910891089108911, - "inlier_rmse_m": 0.33476358801517964, - "target_points": 4583, - "source_points": 4545 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.832468495181616, - "inlier_rmse_m": 0.17412486842640174, - "target_points": 8111, - "source_points": 8094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7515642901207368, - "inlier_rmse_m": 0.11376957872980882, - "target_points": 11643, - "source_points": 11347 - } - ], - "heldout_symmetric": { - "evaluated": 7870, - "inliers": 6044, - "inlier_ratio": 0.7679796696315121, - "inlier_rmse_m": 0.10951225500902462, - "median_m": 0.10664392756136369, - "p90_m": 0.7014033981134332, - "p95_m": 1.167708957590129 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3725.6922742311776, - 5822.541576253114, - 7462.6979868650005, - 8528.000000000002, - 9601.683225652778, - 11782.081936544691 - ], - "effective_rank": 6, - "scaled_condition_number": 3.162387301290471, - "weakest_scaled_direction": [ - 0.0790705900588867, - -0.932163044371149, - -0.02656660605951586, - 0.12907881201037297, - 0.020273489170702683, - -0.32717237332294113 - ] - }, - "forward_reverse": { - "translation_m": 0.0016757410207260358, - "rotation_deg": 0.05240557176555545 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.418631847554177e-15, - "rotation_deg": 1.289908772606522e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 27507, - "frame_counter_j": 31809, - "rtk_translation_m": 1.0853574230860805, - "rtk_rotation_deg": 94.34120990413592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.0774737917964983, - 0.9969044178971386, - -0.013393773248656982, - -0.599104370819824 - ], - [ - -0.9961066769354627, - -0.07796460969780405, - -0.041146175998045306, - -2.0460556577016047 - ], - [ - -0.04206304493573694, - 0.010153876689852135, - 0.9990633608730197, - -0.06456977347893998 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8981, - "backend_objective": 122.77248161555175, - "backend_elapsed_sec": 0.644134900001518, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9304556354916067, - "inlier_rmse_m": 0.33392947703638215, - "target_points": 4583, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8453058752271351, - "inlier_rmse_m": 0.17424813442017423, - "target_points": 8111, - "source_points": 8255 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7604572396274344, - "inlier_rmse_m": 0.11691982832237152, - "target_points": 11643, - "source_points": 11810 - } - ], - "heldout_symmetric": { - "evaluated": 7778, - "inliers": 6152, - "inlier_ratio": 0.7909488300334276, - "inlier_rmse_m": 0.11336174254244849, - "median_m": 0.11077162179588074, - "p90_m": 0.5953055781496817, - "p95_m": 1.0314938480165035 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5285.513181445706, - 7036.582042168637, - 8969.735696078213, - 8981.000000000004, - 9668.315921099103, - 13069.931089522172 - ], - "effective_rank": 6, - "scaled_condition_number": 2.472783746978993, - "weakest_scaled_direction": [ - -0.02041521174353972, - 0.9745670398132297, - 0.043789257582863395, - -0.21318560877541648, - -0.006663483762649722, - 0.048911135283136994 - ] - }, - "forward_reverse": { - "translation_m": 0.0011490974177271606, - "rotation_deg": 0.05798276029492007 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2206195148221764e-15, - "rotation_deg": 9.338612015759784e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 27507, - "frame_counter_j": 32982, - "rtk_translation_m": 0.7190584934612743, - "rtk_rotation_deg": 134.43032499953063, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7064772316148608, - 0.7077038404130722, - -0.006722757944950869, - -1.8720572263389914 - ], - [ - -0.706880454914373, - -0.706058462876409, - -0.042443721098121306, - -0.3359401332858819 - ], - [ - -0.03478424456346403, - -0.025233336386428058, - 0.9990762408670117, - -0.04619665828321918 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8990, - "backend_objective": 136.12321724066575, - "backend_elapsed_sec": 0.476659899999504, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9128092577813248, - "inlier_rmse_m": 0.3476247610770087, - "target_points": 4583, - "source_points": 5012 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8235227013461099, - "inlier_rmse_m": 0.18223131139672322, - "target_points": 8111, - "source_points": 8766 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7254095053659324, - "inlier_rmse_m": 0.12305131427358548, - "target_points": 11643, - "source_points": 12393 - } - ], - "heldout_symmetric": { - "evaluated": 7939, - "inliers": 6081, - "inlier_ratio": 0.7659654868371332, - "inlier_rmse_m": 0.11623488568922577, - "median_m": 0.11960429381219383, - "p90_m": 0.7115026789851359, - "p95_m": 1.1395317599271402 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5102.695102199264, - 6563.307528549691, - 8989.999999999995, - 9137.065239136598, - 9208.347231773269, - 11906.76786851497 - ], - "effective_rank": 6, - "scaled_condition_number": 2.3334272634442037, - "weakest_scaled_direction": [ - 0.6671692458979425, - -0.7099837255146992, - -0.0016549816639571326, - 0.13743119429263742, - 0.12885514906169668, - 0.12375211215780603 - ] - }, - "forward_reverse": { - "translation_m": 0.0007397588392132655, - "rotation_deg": 0.049540488476333674 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.145460554220481e-16, - "rotation_deg": 1.2396521842167964e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 28833, - "frame_counter_j": 31809, - "rtk_translation_m": 1.9962827272376449, - "rtk_rotation_deg": 61.72745990449234, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4742243807087597, - 0.8801409476045534, - -0.021520898939196943, - -2.672409287445898 - ], - [ - -0.8799434966282843, - 0.47304416056320164, - -0.04391656747340022, - -1.4946878308359461 - ], - [ - -0.028472433738319886, - 0.03976348207606856, - 0.9988033770518621, - -0.11821731034246838 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7823, - "backend_objective": 105.71625681544229, - "backend_elapsed_sec": 0.29192269999475684, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9038587311968607, - "inlier_rmse_m": 0.3831056830117933, - "target_points": 4545, - "source_points": 4587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7863113264688067, - "inlier_rmse_m": 0.19477311257448413, - "target_points": 8094, - "source_points": 8255 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6624047417442845, - "inlier_rmse_m": 0.11624766106567246, - "target_points": 11347, - "source_points": 11810 - } - ], - "heldout_symmetric": { - "evaluated": 7964, - "inliers": 5687, - "inlier_ratio": 0.7140883977900553, - "inlier_rmse_m": 0.1080327967474786, - "median_m": 0.1166306809269557, - "p90_m": 0.8552888656673078, - "p95_m": 1.3367494521125305 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3850.595444435127, - 5390.845108368965, - 7035.0708284756965, - 7822.999999999996, - 8801.462134069925, - 11115.761100439679 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8867642059111027, - "weakest_scaled_direction": [ - 0.5129245351410594, - -0.7672415829642169, - -0.0027647038468040794, - 0.11820919787658472, - 0.07773614001367743, - 0.35808491884842014 - ] - }, - "forward_reverse": { - "translation_m": 0.008102122424322853, - "rotation_deg": 0.0646114560547033 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5951283465940646e-15, - "rotation_deg": 4.232124323413277e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 28833, - "frame_counter_j": 32982, - "rtk_translation_m": 3.133843614009462, - "rtk_rotation_deg": 101.81657499988698, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.21114867670221085, - 0.9773624542717918, - -0.01337420303154415, - -4.669182540380757 - ], - [ - -0.9763331507058931, - -0.21154187480045458, - -0.0449845977931874, - -0.7397279064472271 - ], - [ - -0.046795460886833756, - 0.0035592394879551035, - 0.9988981512920404, - -0.15862012183581514 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7303, - "backend_objective": 104.00426364884603, - "backend_elapsed_sec": 0.5567904999988968, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8561452513966481, - "inlier_rmse_m": 0.42872104801597166, - "target_points": 4545, - "source_points": 5012 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7054528861510381, - "inlier_rmse_m": 0.1941442817461832, - "target_points": 8094, - "source_points": 8766 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5892842733801339, - "inlier_rmse_m": 0.11933694655097773, - "target_points": 11347, - "source_points": 12393 - } - ], - "heldout_symmetric": { - "evaluated": 8125, - "inliers": 5350, - "inlier_ratio": 0.6584615384615384, - "inlier_rmse_m": 0.10963878686899117, - "median_m": 0.12883952620852243, - "p90_m": 1.1530804461408888, - "p95_m": 1.7688635930520873 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3611.17377280667, - 4038.304710380714, - 5946.462859828012, - 7302.999999999998, - 8671.644992073267, - 10361.14810041204 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8691912248684632, - "weakest_scaled_direction": [ - 0.7255093952193912, - -0.6174956318625681, - 0.031992979657612754, - 0.09183124267834682, - 0.12141872174137854, - 0.2610291711868787 - ] - }, - "forward_reverse": { - "translation_m": 0.012913229197399395, - "rotation_deg": 0.08080164801156113 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0637240035551623e-15, - "rotation_deg": 3.138941077955824e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 28833, - "frame_counter_j": 34263, - "rtk_translation_m": 3.558853688535236, - "rtk_rotation_deg": 131.87013333415302, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.665885893357196, - 0.7442363502080649, - -0.052040676944756094, - -4.686148764049077 - ], - [ - -0.7422486382336625, - -0.6679120547362869, - -0.05440998233986805, - 1.4979575530323872 - ], - [ - -0.07525248213954802, - 0.002396281897070863, - 0.99716163271804, - -0.14764818061209548 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7039, - "backend_objective": 101.95043676667608, - "backend_elapsed_sec": 0.3740213000055519, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8385471341591434, - "inlier_rmse_m": 0.4226584395802385, - "target_points": 4545, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6887749015865442, - "inlier_rmse_m": 0.18724220982391077, - "target_points": 8094, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5875135631416409, - "inlier_rmse_m": 0.12034805137089082, - "target_points": 11347, - "source_points": 11981 - } - ], - "heldout_symmetric": { - "evaluated": 8196, - "inliers": 5132, - "inlier_ratio": 0.6261591020009761, - "inlier_rmse_m": 0.11484815169172223, - "median_m": 0.14776464386065258, - "p90_m": 1.4826270932549392, - "p95_m": 2.134941103785404 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3476.9419185828733, - 3847.691456440277, - 5493.684977508759, - 7039.000000000002, - 9105.797151913512, - 10954.460260302456 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1506020281084415, - "weakest_scaled_direction": [ - -0.5985728021997281, - 0.7576605391779745, - -0.04816926725040576, - -0.14071862299932578, - -0.12229005737975433, - -0.17488350562329938 - ] - }, - "forward_reverse": { - "translation_m": 0.008079663853152794, - "rotation_deg": 0.06664730348633674 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3177158605295896e-15, - "rotation_deg": 4.494066915548021e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 31809, - "frame_counter_j": 32982, - "rtk_translation_m": 1.4312693216245356, - "rtk_rotation_deg": 40.08911509539463, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7604546992810653, - 0.6493798332611872, - 0.003805587341857169, - -1.6093744404729275 - ], - [ - -0.6493908163673622, - 0.7604372316754344, - 0.005175355015123557, - -1.4007348528775292 - ], - [ - 0.00046686087364744306, - -0.006406936512384466, - 0.9999793663898522, - -0.0272683564827908 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9661, - "backend_objective": 119.8317927619588, - "backend_elapsed_sec": 0.33340759999555303, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9477254588986432, - "inlier_rmse_m": 0.3042620531959812, - "target_points": 4587, - "source_points": 5012 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8817020305726672, - "inlier_rmse_m": 0.1718803263950154, - "target_points": 8255, - "source_points": 8766 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7795529734527555, - "inlier_rmse_m": 0.11137173549762389, - "target_points": 11810, - "source_points": 12393 - } - ], - "heldout_symmetric": { - "evaluated": 8033, - "inliers": 6531, - "inlier_ratio": 0.8130212871903398, - "inlier_rmse_m": 0.10717601941116739, - "median_m": 0.0996994082321531, - "p90_m": 0.49982939262773707, - "p95_m": 1.0108729733094322 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5755.066329351588, - 7068.637538010073, - 9162.933798801023, - 9660.999999999996, - 11184.432473735707, - 14955.589590539239 - ], - "effective_rank": 6, - "scaled_condition_number": 2.598682401671686, - "weakest_scaled_direction": [ - 0.7787364873225127, - 0.5187069679240274, - 0.030873975222724597, - -0.11622228209731789, - 0.19064422952969787, - -0.2714894496747931 - ] - }, - "forward_reverse": { - "translation_m": 0.003986207075465725, - "rotation_deg": 0.014468856174509968 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3222395305563762e-15, - "rotation_deg": 7.355699076232884e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 31809, - "frame_counter_j": 34263, - "rtk_translation_m": 2.8745434122269677, - "rtk_rotation_deg": 70.1426734296607, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.33972918932972096, - 0.9405158115846449, - -0.0037531422365436997, - -3.5889258120435295 - ], - [ - -0.9400576572194859, - 0.3394327361574029, - -0.03281796349122116, - -0.3599511196744382 - ], - [ - -0.029591874228963186, - 0.014677390230421727, - 0.9994542987028676, - -0.10216166788020678 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8290, - "backend_objective": 114.9925741131421, - "backend_elapsed_sec": 0.2534854000041378, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9300860802015536, - "inlier_rmse_m": 0.3674048733474873, - "target_points": 4587, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8066324704759632, - "inlier_rmse_m": 0.18159323475683153, - "target_points": 8255, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.691928887405058, - "inlier_rmse_m": 0.1177762256915009, - "target_points": 11810, - "source_points": 11981 - } - ], - "heldout_symmetric": { - "evaluated": 8104, - "inliers": 5748, - "inlier_ratio": 0.709279368213228, - "inlier_rmse_m": 0.11654592484503022, - "median_m": 0.12778778662503212, - "p90_m": 0.8921357543999808, - "p95_m": 1.3447797102364432 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4142.695121306268, - 5437.061921706253, - 6813.096162183565, - 8290.000000000004, - 11021.161515089289, - 13898.825214966175 - ], - "effective_rank": 6, - "scaled_condition_number": 3.3550200552976293, - "weakest_scaled_direction": [ - 0.8238048241755834, - 0.29907257730105974, - 0.044854095639926594, - -0.0389365835889472, - 0.174003887487674, - -0.4450796612669016 - ] - }, - "forward_reverse": { - "translation_m": 0.004732316748497569, - "rotation_deg": 0.04653511032479733 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.3824530827908755e-15, - "rotation_deg": 1.9862314858153248e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 31809, - "frame_counter_j": 35181, - "rtk_translation_m": 2.368927629183393, - "rtk_rotation_deg": 88.7954400941961, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.029814816757161477, - 0.9994287316041705, - -0.015914997512272072, - -3.243412374107929 - ], - [ - -0.9990120198548247, - 0.02926987783929047, - -0.033440371362412506, - 0.004735287675577525 - ], - [ - -0.032955437902111556, - 0.016896292355181204, - 0.9993139919051106, - -0.10379032573533847 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8373, - "backend_objective": 118.59132336508354, - "backend_elapsed_sec": 0.2745446999979322, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9334768568353068, - "inlier_rmse_m": 0.3670510065795649, - "target_points": 4587, - "source_points": 4645 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8177339901477833, - "inlier_rmse_m": 0.18637295595599868, - "target_points": 8255, - "source_points": 8323 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.69873988149879, - "inlier_rmse_m": 0.11901067326813912, - "target_points": 11810, - "source_points": 11983 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5786, - "inlier_ratio": 0.7151155604993202, - "inlier_rmse_m": 0.11440209684434971, - "median_m": 0.1216741663299143, - "p90_m": 0.8381458554066014, - "p95_m": 1.3114279470681351 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4364.7685392375515, - 5525.283156274473, - 7124.617416477297, - 8372.999999999998, - 10607.405807271305, - 13470.568095065015 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0862044513861178, - "weakest_scaled_direction": [ - 0.862787707069462, - 0.22954314307771514, - 0.046091054193415706, - -0.027896801273310633, - 0.18647651303108798, - -0.4064864220188015 - ] - }, - "forward_reverse": { - "translation_m": 0.013864191008669256, - "rotation_deg": 0.04741774806449891 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.856405086021634e-16, - "rotation_deg": 1.5186511053547035e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 32982, - "frame_counter_j": 34263, - "rtk_translation_m": 1.9888588003695142, - "rtk_rotation_deg": 30.053558334266054, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.868908965439604, - 0.4947220503629185, - 0.01572585970263596, - -2.1758390744145606 - ], - [ - -0.4940176484506772, - 0.8687678564502223, - -0.03448151125094502, - -0.4917849615437186 - ], - [ - -0.030720885370375536, - 0.02219244203769123, - 0.9992816033123317, - -0.08180881208069717 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8855, - "backend_objective": 116.7651370180651, - "backend_elapsed_sec": 0.2415296000035596, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.940163762334663, - "inlier_rmse_m": 0.31990207761053396, - "target_points": 5012, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.851365859477514, - "inlier_rmse_m": 0.17808644533872084, - "target_points": 8766, - "source_points": 8383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.739086887571989, - "inlier_rmse_m": 0.11483183738516008, - "target_points": 12393, - "source_points": 11981 - } - ], - "heldout_symmetric": { - "evaluated": 8265, - "inliers": 6145, - "inlier_ratio": 0.7434966727162734, - "inlier_rmse_m": 0.11011755646689264, - "median_m": 0.1104802224233986, - "p90_m": 0.6491837148121661, - "p95_m": 1.1403140867818369 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4559.253111484775, - 6297.952543616001, - 7851.10894898112, - 8855.000000000004, - 10458.99197079983, - 13742.597351487457 - ], - "effective_rank": 6, - "scaled_condition_number": 3.014221192692681, - "weakest_scaled_direction": [ - -0.5631050169409354, - -0.6528764332468943, - -0.027199034810680877, - 0.11960803028571464, - -0.12298843866724987, - 0.47591288946349586 - ] - }, - "forward_reverse": { - "translation_m": 0.0010075959724342985, - "rotation_deg": 0.03301381213076696 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3554841079649082e-15, - "rotation_deg": 1.7169289501670015e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 32982, - "frame_counter_j": 35181, - "rtk_translation_m": 1.9477165743251885, - "rtk_rotation_deg": 48.70632499880147, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6713607379070221, - 0.7410558961148787, - 0.010531781915325557, - -2.156140556019162 - ], - [ - -0.7401949627381276, - 0.6711592334019456, - -0.04070258660595106, - 0.006047997208989502 - ], - [ - -0.03723139446811288, - 0.019530546656115293, - 0.999115799601464, - -0.05649311856108319 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8772, - "backend_objective": 119.37916779080336, - "backend_elapsed_sec": 0.22624830000131624, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9354144241119483, - "inlier_rmse_m": 0.3321865250236604, - "target_points": 5012, - "source_points": 4645 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.838639913492731, - "inlier_rmse_m": 0.17795091348409858, - "target_points": 8766, - "source_points": 8323 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7320370524910289, - "inlier_rmse_m": 0.11665811697100867, - "target_points": 12393, - "source_points": 11983 - } - ], - "heldout_symmetric": { - "evaluated": 8252, - "inliers": 6213, - "inlier_ratio": 0.7529083858458555, - "inlier_rmse_m": 0.11149633235838309, - "median_m": 0.11468598923882811, - "p90_m": 0.6596001585415143, - "p95_m": 1.1514507063010195 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4437.71308167017, - 6304.289558517579, - 7758.148142191611, - 8772.000000000004, - 10363.048352403117, - 13658.954627328989 - ], - "effective_rank": 6, - "scaled_condition_number": 3.077926485095861, - "weakest_scaled_direction": [ - 0.6130492329020204, - 0.6015994153292139, - 0.02250630239961287, - -0.10870269192423018, - 0.12884237751495034, - -0.4830379016089841 - ] - }, - "forward_reverse": { - "translation_m": 0.001989351505445817, - "rotation_deg": 0.010666288445208057 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.757191532588119e-16, - "rotation_deg": 5.0123107028878386e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 32982, - "frame_counter_j": 36694, - "rtk_translation_m": 3.76075382790461, - "rtk_rotation_deg": 86.89547500633407, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.064419095777963, - 0.9979226956371441, - -0.0006882088646808393, - -4.385660714479803 - ], - [ - -0.9974292416076147, - 0.06436552091052775, - -0.03149583629578438, - 0.7476766510045003 - ], - [ - -0.03138611293556503, - 0.002715372940911433, - 0.9995036461487209, - -0.042782622205513474 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8123, - "backend_objective": 115.58818115359027, - "backend_elapsed_sec": 0.6545534000033513, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.89183979438852, - "inlier_rmse_m": 0.3690124918126037, - "target_points": 5012, - "source_points": 4669 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7836271432021251, - "inlier_rmse_m": 0.1802963800469888, - "target_points": 8766, - "source_points": 8282 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6933253670194606, - "inlier_rmse_m": 0.11928847549435614, - "target_points": 12393, - "source_points": 11716 - } - ], - "heldout_symmetric": { - "evaluated": 8116, - "inliers": 5768, - "inlier_ratio": 0.7106949236076885, - "inlier_rmse_m": 0.11526418670282225, - "median_m": 0.1263078783602123, - "p90_m": 1.0084575875480692, - "p95_m": 1.6045751703038522 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3452.0896442319086, - 4954.683840831884, - 5982.302695891699, - 8123.000000000002, - 10843.370477454715, - 13408.664347965645 - ], - "effective_rank": 6, - "scaled_condition_number": 3.884216729530811, - "weakest_scaled_direction": [ - -0.5564130327353374, - -0.5869393823697387, - -0.03294540153764039, - 0.07078594796117446, - -0.09934624480850544, - 0.5744048852132991 - ] - }, - "forward_reverse": { - "translation_m": 0.0033123302523526757, - "rotation_deg": 0.010450448797924646 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.492254001416113e-15, - "rotation_deg": 1.640275544992695e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 34263, - "frame_counter_j": 35181, - "rtk_translation_m": 0.8778876913955667, - "rtk_rotation_deg": 18.652766664535406, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9501738877757449, - 0.31171998460474853, - -0.00048392886066137166, - -0.2286601337601427 - ], - [ - -0.3117172286694341, - 0.9501562385369092, - -0.005957492764625754, - 0.4424891656359119 - ], - [ - -0.0013972615269065786, - 0.005811503024878834, - 0.9999821368868628, - 0.0064978234845835875 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10372, - "backend_objective": 87.25901198230859, - "backend_elapsed_sec": 0.2675770000059856, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9692142088266954, - "inlier_rmse_m": 0.25010988461111566, - "target_points": 4763, - "source_points": 4645 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9294725459569867, - "inlier_rmse_m": 0.14380652316860595, - "target_points": 8383, - "source_points": 8323 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8655595426854711, - "inlier_rmse_m": 0.09172207932836982, - "target_points": 11981, - "source_points": 11983 - } - ], - "heldout_symmetric": { - "evaluated": 8323, - "inliers": 7325, - "inlier_ratio": 0.8800913132284032, - "inlier_rmse_m": 0.0910569893232571, - "median_m": 0.06639615125711015, - "p90_m": 0.2805815291306941, - "p95_m": 0.48256303211927165 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5852.014630148945, - 7079.862027450226, - 10051.435212894148, - 10371.999999999998, - 11115.48173138091, - 14103.635377532242 - ], - "effective_rank": 6, - "scaled_condition_number": 2.4100478670835583, - "weakest_scaled_direction": [ - -0.17193127848027648, - -0.9310431981401306, - 0.0003981345597114271, - 0.20595300278959955, - -0.037927831573805554, - 0.24442356760358308 - ] - }, - "forward_reverse": { - "translation_m": 0.0032245216994413483, - "rotation_deg": 0.016462830433921317 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9019690459112888e-15, - "rotation_deg": 5.781810832073445e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 34263, - "frame_counter_j": 36694, - "rtk_translation_m": 2.2510479983846268, - "rtk_rotation_deg": 56.84191667206801, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5497174412389825, - 0.8351381020352151, - -0.01884370788046884, - -2.528730235688344 - ], - [ - -0.8353447394184166, - 0.5496586319721631, - -0.008634501981436145, - -0.013988679319308524 - ], - [ - 0.0031466050980656934, - 0.020487528584695023, - 0.9997851569456552, - -0.07651753706622187 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8716, - "backend_objective": 116.43364597375755, - "backend_elapsed_sec": 0.27838709999923594, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9355322338830585, - "inlier_rmse_m": 0.33270196990585055, - "target_points": 4763, - "source_points": 4669 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8487080415358609, - "inlier_rmse_m": 0.1813408367409407, - "target_points": 8383, - "source_points": 8282 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7439399112325026, - "inlier_rmse_m": 0.11557945379372693, - "target_points": 11981, - "source_points": 11716 - } - ], - "heldout_symmetric": { - "evaluated": 8187, - "inliers": 6115, - "inlier_ratio": 0.746915842188836, - "inlier_rmse_m": 0.11145740682737049, - "median_m": 0.11086209434505608, - "p90_m": 0.613500953280635, - "p95_m": 1.010983383905269 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4143.88935174857, - 4933.467800339045, - 7175.098582464223, - 8716.0, - 9912.425790479992, - 11817.902041520336 - ], - "effective_rank": 6, - "scaled_condition_number": 2.851886485949151, - "weakest_scaled_direction": [ - -0.3989745655648477, - -0.7999634214074877, - -0.02209276892971602, - 0.11052125480668937, - -0.06695801339249705, - 0.4285923549036652 - ] - }, - "forward_reverse": { - "translation_m": 0.01259476909551429, - "rotation_deg": 0.07575320422516746 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.331199964942716e-16, - "rotation_deg": 7.314227314952128e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 34263, - "frame_counter_j": 38208, - "rtk_translation_m": 3.452614527841686, - "rtk_rotation_deg": 105.36038662410485, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.2610113242361111, - 0.9642598895532162, - -0.045562638414955905, - -4.666889870493934 - ], - [ - -0.9645177704987861, - -0.26244210885170466, - -0.028802949389281348, - 0.26237251983316073 - ], - [ - -0.03973108370738399, - 0.036428078460033576, - 0.998546161219974, - -0.1610252533293348 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7084, - "backend_objective": 95.06135980965016, - "backend_elapsed_sec": 0.2470270999983768, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8335687382297552, - "inlier_rmse_m": 0.4133720697253466, - "target_points": 4763, - "source_points": 4248 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.729145211122554, - "inlier_rmse_m": 0.1898991248393603, - "target_points": 8383, - "source_points": 7768 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6281255541762724, - "inlier_rmse_m": 0.11584111656521846, - "target_points": 11981, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 8396, - "inliers": 5208, - "inlier_ratio": 0.6202953787517865, - "inlier_rmse_m": 0.10996904036547328, - "median_m": 0.1447533230234363, - "p90_m": 1.3271896863707051, - "p95_m": 2.0086694565166887 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2957.697905386778, - 4101.985299949057, - 5398.292856857947, - 7084.000000000003, - 8486.649037843066, - 10194.951972718347 - ], - "effective_rank": 6, - "scaled_condition_number": 3.4469213215286616, - "weakest_scaled_direction": [ - -0.391594622738966, - -0.7794648855145322, - -0.04018518752953335, - 0.07377087416107388, - -0.061690942183920315, - 0.4777294005741461 - ] - }, - "forward_reverse": { - "translation_m": 0.01971125516503169, - "rotation_deg": 0.10319789629151777 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2732477266632935e-15, - "rotation_deg": 1.1861531410038084e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 35181, - "frame_counter_j": 36694, - "rtk_translation_m": 1.8212773036309853, - "rtk_rotation_deg": 38.18915000753262, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7826274023679262, - 0.622289875851672, - -0.015800616296324475, - -2.0438653339808854 - ], - [ - -0.6224016976211989, - 0.7826922950301728, - -0.0029829680941321555, - -1.153048646335678 - ], - [ - 0.010510749786894362, - 0.012168882977150585, - 0.9998707128554197, - -0.053891595600106514 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9199, - "backend_objective": 127.05552821161197, - "backend_elapsed_sec": 0.1841294999976526, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9522381666309703, - "inlier_rmse_m": 0.315837583032669, - "target_points": 4645, - "source_points": 4669 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8740642356918619, - "inlier_rmse_m": 0.1709280142022179, - "target_points": 8323, - "source_points": 8282 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7851655855240697, - "inlier_rmse_m": 0.11752397539688447, - "target_points": 11983, - "source_points": 11716 - } - ], - "heldout_symmetric": { - "evaluated": 8174, - "inliers": 6424, - "inlier_ratio": 0.7859065329092244, - "inlier_rmse_m": 0.11467536863831725, - "median_m": 0.11122568708625953, - "p90_m": 0.5452914252620967, - "p95_m": 0.823598812691465 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4436.477561068043, - 6136.33184417499, - 8185.727790872579, - 9199.0, - 10127.99519773632, - 12609.589723951489 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8422525641977647, - "weakest_scaled_direction": [ - 0.018441747003857107, - 0.9147806831732815, - 0.016435297251389886, - -0.13338176487333436, - 0.009522894045598407, - -0.3803744259975941 - ] - }, - "forward_reverse": { - "translation_m": 0.011606021246419816, - "rotation_deg": 0.08140725284903579 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.316218999379179e-15, - "rotation_deg": 1.1228131163655216e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 35181, - "frame_counter_j": 38208, - "rtk_translation_m": 2.999856552735995, - "rtk_rotation_deg": 86.70761995956946, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.052285044790317675, - 0.9980755228258963, - -0.03333953849544011, - -4.163749083521323 - ], - [ - -0.9982736722901397, - 0.05134261898043672, - -0.028523861740460676, - -1.5585196145552334 - ], - [ - -0.026757228997668876, - 0.034773354914994274, - 0.9990369685273519, - -0.13897060086451063 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7199, - "backend_objective": 99.77714307774747, - "backend_elapsed_sec": 0.1993984000000637, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.852165725047081, - "inlier_rmse_m": 0.40779593647415696, - "target_points": 4645, - "source_points": 4248 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.743692070030896, - "inlier_rmse_m": 0.19292572943004577, - "target_points": 8323, - "source_points": 7768 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6383223975882248, - "inlier_rmse_m": 0.11772791308497153, - "target_points": 11983, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 8383, - "inliers": 5335, - "inlier_ratio": 0.6364070141953955, - "inlier_rmse_m": 0.11293944470788622, - "median_m": 0.1422322766737924, - "p90_m": 1.2229820895932704, - "p95_m": 1.7895086155245634 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3059.692099733616, - 3808.109854985119, - 5432.4791401313505, - 7199.000000000001, - 8464.144547339743, - 9910.300538129859 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2389862166172447, - "weakest_scaled_direction": [ - 0.052143965758799565, - 0.8857425848150134, - 0.03248478380260908, - -0.09422061961597403, - 0.02204339888407804, - -0.4498026039345274 - ] - }, - "forward_reverse": { - "translation_m": 0.02314438992859391, - "rotation_deg": 0.07068788850704667 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0350724194510405e-15, - "rotation_deg": 6.677568874663973e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 35181, - "frame_counter_j": 39321, - "rtk_translation_m": 1.7088514993141615, - "rtk_rotation_deg": 157.34900000166795, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9202522101746515, - 0.3857344443519084, - -0.06591515841742084, - -3.973100088752827 - ], - [ - -0.3844666715885819, - -0.9226028102064369, - -0.03145525451785251, - 0.28793252508528405 - ], - [ - -0.0729468855145066, - -0.0036045859276800873, - 0.9973293131428674, - -0.1190784963622508 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7062, - "backend_objective": 93.35526530760096, - "backend_elapsed_sec": 0.3161863999994239, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8435527502254283, - "inlier_rmse_m": 0.41372301585434074, - "target_points": 4645, - "source_points": 4436 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7222152925034302, - "inlier_rmse_m": 0.192272595125982, - "target_points": 8323, - "source_points": 8017 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6162303664921466, - "inlier_rmse_m": 0.11497556492868967, - "target_points": 11983, - "source_points": 11460 - } - ], - "heldout_symmetric": { - "evaluated": 8350, - "inliers": 5136, - "inlier_ratio": 0.6150898203592814, - "inlier_rmse_m": 0.11134349524292353, - "median_m": 0.1477351586727783, - "p90_m": 1.4296044668723442, - "p95_m": 2.13811799162504 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3003.969287069754, - 4689.396450229394, - 5846.620771039429, - 7061.999999999998, - 8194.990657158258, - 10212.178301331418 - ], - "effective_rank": 6, - "scaled_condition_number": 3.3995614886239296, - "weakest_scaled_direction": [ - -0.04442068111618893, - 0.8867521697643117, - 0.015845535904241755, - -0.09837428063035697, - 0.0030984804124675833, - -0.4491761478851693 - ] - }, - "forward_reverse": { - "translation_m": 0.039322949699257106, - "rotation_deg": 0.11562859307450143 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8435583831733384e-15, - "rotation_deg": 1.5959012648339225e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 36694, - "frame_counter_j": 38208, - "rtk_translation_m": 1.2059352225587747, - "rtk_rotation_deg": 48.51846995203683, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6619495657163322, - 0.7495459040925998, - 0.0019261635355619063, - -1.406353262892494 - ], - [ - -0.749178248520868, - 0.6617012554918545, - -0.02972205281786154, - -1.6408167488311056 - ], - [ - -0.023552587780616, - 0.018231460131044312, - 0.9995563463208696, - -0.05203677049616308 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8801, - "backend_objective": 124.66649150083329, - "backend_elapsed_sec": 0.2798739999998361, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.905367231638418, - "inlier_rmse_m": 0.30656239981449057, - "target_points": 4669, - "source_points": 4248 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8635427394438723, - "inlier_rmse_m": 0.17816608838697054, - "target_points": 8282, - "source_points": 7768 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.780368859726902, - "inlier_rmse_m": 0.11901696138850008, - "target_points": 11716, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 8247, - "inliers": 6481, - "inlier_ratio": 0.7858615254031769, - "inlier_rmse_m": 0.11149776506996652, - "median_m": 0.10589277126614312, - "p90_m": 0.5765422280306121, - "p95_m": 1.0091060719649088 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4206.653952926795, - 5905.422005052108, - 8678.872919438541, - 8801.0, - 8953.669272987665, - 10419.256149060351 - ], - "effective_rank": 6, - "scaled_condition_number": 2.476851261276463, - "weakest_scaled_direction": [ - 0.34840627888403636, - -0.9199615106421936, - -0.027645366708712954, - 0.11290446891079552, - 0.03881034670715932, - 0.13139998234054417 - ] - }, - "forward_reverse": { - "translation_m": 0.011240124367435099, - "rotation_deg": 0.1049569848741807 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.153260759027211e-15, - "rotation_deg": 3.77325537826874e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 36694, - "frame_counter_j": 39321, - "rtk_translation_m": 1.1958827550030364, - "rtk_rotation_deg": 119.15984999413537, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.48163101688703847, - 0.8760474222890251, - -0.02392650148081696, - -2.405557469171915 - ], - [ - -0.8746962546338595, - -0.482218334231548, - -0.04870256934134998, - -0.0764884094070427 - ], - [ - -0.05420355801841043, - -0.002528246765123825, - 0.9985267058353725, - -0.040090849692894545 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8475, - "backend_objective": 105.79779951683777, - "backend_elapsed_sec": 0.32555560000037076, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8814247069431921, - "inlier_rmse_m": 0.3201435002965957, - "target_points": 4669, - "source_points": 4436 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8266184358238743, - "inlier_rmse_m": 0.17677315859363205, - "target_points": 8282, - "source_points": 8017 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7395287958115183, - "inlier_rmse_m": 0.11172965661443025, - "target_points": 11716, - "source_points": 11460 - } - ], - "heldout_symmetric": { - "evaluated": 8214, - "inliers": 6125, - "inlier_ratio": 0.7456781105429754, - "inlier_rmse_m": 0.10341842736085993, - "median_m": 0.10031990254444013, - "p90_m": 0.8310519670734703, - "p95_m": 1.729387714700435 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3894.1431261851744, - 4716.146261569608, - 7595.5926767152005, - 8475.0, - 8884.797012856003, - 9852.257872700458 - ], - "effective_rank": 6, - "scaled_condition_number": 2.5300194557440525, - "weakest_scaled_direction": [ - 0.7319798806141741, - -0.6598084652171529, - 0.006291869543906546, - 0.08289031527002091, - 0.09305630789262938, - 0.11527521493068577 - ] - }, - "forward_reverse": { - "translation_m": 0.01395883182919579, - "rotation_deg": 0.08780591339848752 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0526613085723957e-15, - "rotation_deg": 4.087205881500462e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 36694, - "frame_counter_j": 42886, - "rtk_translation_m": 3.786115539231191, - "rtk_rotation_deg": 149.59794999698258, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8619960848867485, - 0.5065623334478525, - -0.018903755494200775, - -1.5082200458801782 - ], - [ - -0.5060127868824644, - -0.8620873383156574, - -0.027504192903404764, - 3.0133588367578907 - ], - [ - -0.03022927639491411, - -0.014142964600539576, - 0.9994429285361658, - 0.05538824755784028 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7300, - "backend_objective": 100.55554230705866, - "backend_elapsed_sec": 0.25816199999826495, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8750620963735718, - "inlier_rmse_m": 0.3182996083755302, - "target_points": 4669, - "source_points": 4026 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.806178643384822, - "inlier_rmse_m": 0.188677773735723, - "target_points": 8282, - "source_points": 7445 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.67598851745532, - "inlier_rmse_m": 0.11736580346457288, - "target_points": 11716, - "source_points": 10799 - } - ], - "heldout_symmetric": { - "evaluated": 8082, - "inliers": 5022, - "inlier_ratio": 0.621380846325167, - "inlier_rmse_m": 0.10953325191126222, - "median_m": 0.1422625597907486, - "p90_m": 3.120269434910362, - "p95_m": 3.724170218338392 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3174.350712194711, - 3965.7702242991995, - 5171.989393119404, - 7299.999999999999, - 9853.848942153136, - 11860.530525075257 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7363642522268807, - "weakest_scaled_direction": [ - -0.40635424281695215, - -0.6924443916708792, - -0.0058366150135461, - 0.09890105490275236, - -0.06296570286543712, - 0.5844799648535228 - ] - }, - "forward_reverse": { - "translation_m": 0.016637332395867215, - "rotation_deg": 0.10353943868518889 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7111102964946756e-15, - "rotation_deg": 1.8660731793843815e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 38208, - "frame_counter_j": 39321, - "rtk_translation_m": 1.8270495459501794, - "rtk_rotation_deg": 70.64138004209858, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.33784223156240467, - 0.941200563096158, - -0.0020314035567020015, - -1.8361928772719904 - ], - [ - -0.9407812870260441, - 0.3376255768138792, - -0.03065191450326094, - 0.2842211173705592 - ], - [ - -0.028163745392871215, - 0.012266617649985101, - 0.9995280554025856, - -0.022715874215958498 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9006, - "backend_objective": 115.09932521893542, - "backend_elapsed_sec": 0.2220108000037726, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.940712353471596, - "inlier_rmse_m": 0.2897985677413864, - "target_points": 4248, - "source_points": 4436 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8929774229761757, - "inlier_rmse_m": 0.1773590650348633, - "target_points": 7768, - "source_points": 8017 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7858638743455497, - "inlier_rmse_m": 0.11304996115613417, - "target_points": 11278, - "source_points": 11460 - } - ], - "heldout_symmetric": { - "evaluated": 8423, - "inliers": 7031, - "inlier_ratio": 0.8347382167873679, - "inlier_rmse_m": 0.10115747661888057, - "median_m": 0.0807386130161531, - "p90_m": 0.38316205036726836, - "p95_m": 0.6627584276484652 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3968.9260087442676, - 6334.372302297862, - 8147.067585220671, - 9006.000000000002, - 9909.260825171657, - 12038.981279951038 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0333095788198037, - "weakest_scaled_direction": [ - 0.9567071976758192, - -0.15181006636224853, - 0.009983884210126269, - 0.02191933267560829, - 0.12407818585977311, - -0.21375104764948588 - ] - }, - "forward_reverse": { - "translation_m": 0.01268722454395532, - "rotation_deg": 0.041403863092781025 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0136546070495328e-15, - "rotation_deg": 5.7475714746660935e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 38208, - "frame_counter_j": 42886, - "rtk_translation_m": 4.741885618180033, - "rtk_rotation_deg": 101.07948004494568, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1908249589813287, - 0.9814824198209097, - -0.016676168992500077, - -3.557526979209888 - ], - [ - -0.9815071818816863, - -0.19103687027145058, - -0.012188769895278383, - 3.0019529723649003 - ], - [ - -0.015148826503903088, - 0.014041858117112139, - 0.9997866468783085, - -0.029347544139863554 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6751, - "backend_objective": 105.45835108424839, - "backend_elapsed_sec": 0.3560858000055305, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8825136612021858, - "inlier_rmse_m": 0.371105431590949, - "target_points": 4248, - "source_points": 4026 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7683008730691739, - "inlier_rmse_m": 0.19701064952441194, - "target_points": 7768, - "source_points": 7445 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6251504768960089, - "inlier_rmse_m": 0.12498457975349939, - "target_points": 11278, - "source_points": 10799 - } - ], - "heldout_symmetric": { - "evaluated": 8291, - "inliers": 5177, - "inlier_ratio": 0.624412013026173, - "inlier_rmse_m": 0.11277808045896366, - "median_m": 0.14597680424657858, - "p90_m": 3.0723345878898263, - "p95_m": 3.6739297437123932 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3317.582080125103, - 3637.103530286624, - 4774.224976040836, - 6751.000000000003, - 10816.30261231022, - 12964.599183909495 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9078457957611743, - "weakest_scaled_direction": [ - 0.9158050392918896, - -0.2750058274441981, - 0.0511827584222075, - 0.06370859077131633, - 0.17058484939097318, - -0.22337250220158716 - ] - }, - "forward_reverse": { - "translation_m": 0.025589655197266314, - "rotation_deg": 0.15422514597254583 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.554455567156805e-15, - "rotation_deg": 2.392139390999001e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 38208, - "frame_counter_j": 43788, - "rtk_translation_m": 3.8640843382258447, - "rtk_rotation_deg": 141.59343004213218, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7832953076620306, - 0.6207493436424748, - -0.033447172706805424, - -5.470864024235026 - ], - [ - -0.6197124234799911, - -0.7839675894733129, - -0.0367604521185518, - 1.3521482551568849 - ], - [ - -0.049040525886243386, - -0.008066661195308284, - 0.9987642143158503, - -0.09830694589220926 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6227, - "backend_objective": 100.59870961441808, - "backend_elapsed_sec": 0.6188537999987602, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7967160037002775, - "inlier_rmse_m": 0.3858191173348666, - "target_points": 4248, - "source_points": 4324 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6807667731629393, - "inlier_rmse_m": 0.2020925025823932, - "target_points": 7768, - "source_points": 7825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5534127266263775, - "inlier_rmse_m": 0.1271032841405586, - "target_points": 11278, - "source_points": 11252 - } - ], - "heldout_symmetric": { - "evaluated": 8432, - "inliers": 4949, - "inlier_ratio": 0.5869307400379506, - "inlier_rmse_m": 0.11770827672499123, - "median_m": 0.17402671110188572, - "p90_m": 2.339832730148668, - "p95_m": 3.195192301330167 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2618.6526881548284, - 2954.8693291023587, - 3847.8597464442832, - 6227.000000000003, - 10881.192997125874, - 12567.238392380366 - ], - "effective_rank": 6, - "scaled_condition_number": 4.799123781945888, - "weakest_scaled_direction": [ - 0.8070603101578072, - -0.513554364524687, - 0.03868541007651403, - 0.06651080515395953, - 0.12354004558706297, - 0.2524543115634175 - ] - }, - "forward_reverse": { - "translation_m": 0.022027669812843296, - "rotation_deg": 0.2897817423195282 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.4688917960252738e-15, - "rotation_deg": 2.317785400167932e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 39321, - "frame_counter_j": 42886, - "rtk_translation_m": 2.939444415707082, - "rtk_rotation_deg": 30.43810000284707, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.85948355895999, - 0.5107472919873962, - -0.020620756654679332, - -3.138152145854864 - ], - [ - -0.5109793328034614, - 0.859557167422551, - -0.007848399852881981, - -0.6953590054116972 - ], - [ - 0.01371617020891213, - 0.017282351115006638, - 0.9997565638767957, - -0.09229435044206188 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7237, - "backend_objective": 108.3795623115383, - "backend_elapsed_sec": 0.28930550000222865, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9085941381023348, - "inlier_rmse_m": 0.37997208439730296, - "target_points": 4436, - "source_points": 4026 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7841504365345869, - "inlier_rmse_m": 0.18412186040748135, - "target_points": 8017, - "source_points": 7445 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6701546439485138, - "inlier_rmse_m": 0.1223754805103624, - "target_points": 11460, - "source_points": 10799 - } - ], - "heldout_symmetric": { - "evaluated": 8258, - "inliers": 5434, - "inlier_ratio": 0.6580285783482683, - "inlier_rmse_m": 0.1098010629341849, - "median_m": 0.1328431374214946, - "p90_m": 1.7262530899229227, - "p95_m": 2.802456369804973 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3582.889903568551, - 4901.896129056462, - 5997.707899149264, - 7237.000000000001, - 10102.006589650251, - 12579.695220985031 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5110471043097586, - "weakest_scaled_direction": [ - 0.5352948574092355, - 0.7857372397599693, - 0.03626905539607693, - -0.1231678164775793, - 0.0961525382748362, - -0.26522695879894737 - ] - }, - "forward_reverse": { - "translation_m": 0.0028795138573569803, - "rotation_deg": 0.007524827744647535 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3250161650848995e-15, - "rotation_deg": 2.1963351598227244e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 39321, - "frame_counter_j": 43788, - "rtk_translation_m": 2.285770454773634, - "rtk_rotation_deg": 70.95205000003368, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.31944914639733446, - 0.9476023447117956, - -0.0014279925491863606, - -2.231723967216059 - ], - [ - -0.947280480340614, - 0.31930057734977774, - -0.026586328624939554, - -3.0617070140649774 - ], - [ - -0.024737308496864653, - 0.009845689452992036, - 0.9996455011490479, - -0.08211712384490312 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6991, - "backend_objective": 102.29493559188708, - "backend_elapsed_sec": 0.4588796999960323, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8469010175763182, - "inlier_rmse_m": 0.36917357955105157, - "target_points": 4436, - "source_points": 4324 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7410862619808307, - "inlier_rmse_m": 0.19114239974722216, - "target_points": 8017, - "source_points": 7825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6213117667970138, - "inlier_rmse_m": 0.12096435541656723, - "target_points": 11460, - "source_points": 11252 - } - ], - "heldout_symmetric": { - "evaluated": 8399, - "inliers": 5605, - "inlier_ratio": 0.6673413501607334, - "inlier_rmse_m": 0.11114983317987888, - "median_m": 0.13020484613145425, - "p90_m": 1.6188537877269014, - "p95_m": 2.3417714420876536 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3089.623536145622, - 3857.195301542715, - 5064.459800773706, - 6990.999999999998, - 10185.483813953808, - 12010.453563167755 - ], - "effective_rank": 6, - "scaled_condition_number": 3.8873517833668108, - "weakest_scaled_direction": [ - -0.6216609367379673, - -0.7669559423377654, - -0.041205353145335716, - 0.11046597635081433, - -0.09241927788918439, - 0.05361274346957316 - ] - }, - "forward_reverse": { - "translation_m": 0.008151782060846088, - "rotation_deg": 0.22733511766651973 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7728365233289085e-15, - "rotation_deg": 3.185940081225278e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 39321, - "frame_counter_j": 45217, - "rtk_translation_m": 3.6568094249627374, - "rtk_rotation_deg": 131.92299999999997, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6698133360221045, - 0.7420805770230317, - -0.025816895477654735, - -3.027344942217452 - ], - [ - -0.7407647281232863, - -0.670213075420908, - -0.04562949817039006, - -4.5308890585151484 - ], - [ - -0.05116358524745357, - -0.011439000831031262, - 0.9986247727773503, - -0.11929062518469426 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5750, - "backend_objective": 82.09776216064724, - "backend_elapsed_sec": 0.2876821000027121, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7965663217309501, - "inlier_rmse_m": 0.42640525684459196, - "target_points": 4436, - "source_points": 4252 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6639852301200053, - "inlier_rmse_m": 0.20253376671567005, - "target_points": 8017, - "source_points": 7583 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5304917427806993, - "inlier_rmse_m": 0.11949004845639892, - "target_points": 11460, - "source_points": 10839 - } - ], - "heldout_symmetric": { - "evaluated": 8403, - "inliers": 4770, - "inlier_ratio": 0.567654409139593, - "inlier_rmse_m": 0.1129321723600836, - "median_m": 0.1782847349615507, - "p90_m": 1.8092316307324496, - "p95_m": 2.56657939779986 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2434.032313993468, - 2728.9691909944268, - 3802.122878026226, - 5750.000000000001, - 8196.747880886694, - 9563.764678497457 - ], - "effective_rank": 6, - "scaled_condition_number": 3.929185583738771, - "weakest_scaled_direction": [ - -0.04754146690967991, - -0.8759076038019032, - -0.07336264458630966, - 0.13600437344865327, - -0.0452668277161272, - 0.4523243588584916 - ] - }, - "forward_reverse": { - "translation_m": 0.018525590401292088, - "rotation_deg": 0.6411617076853331 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.424555649859924e-15, - "rotation_deg": 4.4541882101533745e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 42886, - "frame_counter_j": 43788, - "rtk_translation_m": 2.3764785758716087, - "rtk_rotation_deg": 40.513949997186636, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7582634295278259, - 0.6513338136052004, - 0.028299022866628287, - 1.9855414358960637 - ], - [ - -0.6513997709329481, - 0.7586915928871146, - -0.008087355001243864, - -1.570458975563803 - ], - [ - -0.02673779851077035, - -0.012301631473895746, - 0.9995667861598233, - 3.2016741979029656e-05 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8410, - "backend_objective": 107.07786923230618, - "backend_elapsed_sec": 0.18896200000017416, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8885291396854764, - "inlier_rmse_m": 0.3086075260161187, - "target_points": 4026, - "source_points": 4324 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.834888178913738, - "inlier_rmse_m": 0.17371214920002417, - "target_points": 7445, - "source_points": 7825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7474226804123711, - "inlier_rmse_m": 0.11283708607691408, - "target_points": 10799, - "source_points": 11252 - } - ], - "heldout_symmetric": { - "evaluated": 8267, - "inliers": 6577, - "inlier_ratio": 0.795572759162937, - "inlier_rmse_m": 0.10258057277674534, - "median_m": 0.09293438990243921, - "p90_m": 0.5219210606558571, - "p95_m": 0.9681732539514523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3655.4049541283216, - 5687.375251140884, - 7355.364810334369, - 8410.000000000002, - 9480.3293486125, - 11474.029575480068 - ], - "effective_rank": 6, - "scaled_condition_number": 3.138921602248635, - "weakest_scaled_direction": [ - 0.10318647833645103, - 0.9480176479963048, - 0.011777143054927157, - -0.11947805255459108, - 0.009577293984319975, - 0.27587979098737886 - ] - }, - "forward_reverse": { - "translation_m": 0.0021193681800924964, - "rotation_deg": 0.11642323746608753 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0195400078307063e-15, - "rotation_deg": 1.0266756245487012e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 42886, - "frame_counter_j": 45217, - "rtk_translation_m": 4.061689152213973, - "rtk_rotation_deg": 101.48489999715295, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1981968431613316, - 0.9800276338690729, - 0.016243405242429107, - 2.050785526295448 - ], - [ - -0.9799000018353319, - -0.19773328612923755, - -0.026410868210828935, - -3.2441899388379714 - ], - [ - -0.022671518784572228, - -0.021151463531404572, - 0.9995191933257109, - -0.037471085470248286 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7481, - "backend_objective": 97.73352765830437, - "backend_elapsed_sec": 0.37698359999922104, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8574788334901223, - "inlier_rmse_m": 0.3690874958951018, - "target_points": 4026, - "source_points": 4252 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7781880522220757, - "inlier_rmse_m": 0.19176257733530702, - "target_points": 7445, - "source_points": 7583 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6901928222160716, - "inlier_rmse_m": 0.11429887610225564, - "target_points": 10799, - "source_points": 10839 - } - ], - "heldout_symmetric": { - "evaluated": 8271, - "inliers": 6154, - "inlier_ratio": 0.7440454600411075, - "inlier_rmse_m": 0.10506613395932038, - "median_m": 0.10259339470439534, - "p90_m": 0.7262009741269034, - "p95_m": 1.279780438731719 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3565.277205230247, - 4777.807147972587, - 6323.152242347124, - 7480.999999999998, - 9133.655859792325, - 11133.473031055011 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1227510205159508, - "weakest_scaled_direction": [ - -0.018127436346611722, - -0.96467103260991, - -0.040648410360683306, - 0.14675155755696737, - 0.006265349962763076, - -0.21413460106770918 - ] - }, - "forward_reverse": { - "translation_m": 0.010617830050775887, - "rotation_deg": 0.010252586949293494 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4702462297909733e-15, - "rotation_deg": 5.737773347625084e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 42886, - "frame_counter_j": 46130, - "rtk_translation_m": 5.033742765789926, - "rtk_rotation_deg": 178.61309998505533, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9990947562200762, - 0.019821018766673963, - 0.03764034150482836, - -7.565396454881804 - ], - [ - -0.020546624578864442, - -0.9996085440128404, - -0.018989337927982314, - 0.5008831856738594 - ], - [ - 0.037249218944350286, - -0.019745529913858105, - 0.9991109096273814, - 0.21356125074900986 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5547, - "backend_objective": 74.38327591170987, - "backend_elapsed_sec": 0.6036733999935677, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.6745513866231647, - "inlier_rmse_m": 0.4615830224228183, - "target_points": 4026, - "source_points": 3678 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5733880090497737, - "inlier_rmse_m": 0.18504916795560133, - "target_points": 7445, - "source_points": 7072 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5211386696730552, - "inlier_rmse_m": 0.11580000220420524, - "target_points": 10799, - "source_points": 10644 - } - ], - "heldout_symmetric": { - "evaluated": 8283, - "inliers": 4825, - "inlier_ratio": 0.5825184112036702, - "inlier_rmse_m": 0.11453665822491028, - "median_m": 0.1651275266926561, - "p90_m": 2.8912989450728825, - "p95_m": 5.354127869942276 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1123.8621705005744, - 2535.35437677658, - 2940.2317943778444, - 5546.999999999996, - 7900.510065833345, - 8598.627143362954 - ], - "effective_rank": 6, - "scaled_condition_number": 7.650962341345717, - "weakest_scaled_direction": [ - 0.8627479588658187, - -0.38708487699776284, - -0.005848961436697701, - 0.029997593897527285, - 0.06205643855687307, - 0.31787763355825793 - ] - }, - "forward_reverse": { - "translation_m": 2.5431128502617377, - "rotation_deg": 2.5742599673919253 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.063725831826059e-15, - "rotation_deg": 5.5426964532438425e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 43788, - "frame_counter_j": 45217, - "rtk_translation_m": 1.7860052935263149, - "rtk_rotation_deg": 60.970949999966315, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.488775037626749, - 0.8723923593222279, - 0.005525756886290697, - 1.1394532445627192 - ], - [ - -0.8720747956679231, - 0.48875304322996627, - -0.02461734133079542, - -1.2263629108030767 - ], - [ - -0.024176710978136742, - 0.007213468627707474, - 0.9996816755931047, - 0.011143377216418419 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8711, - "backend_objective": 106.29217481021797, - "backend_elapsed_sec": 0.17922940000426024, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9574317968015051, - "inlier_rmse_m": 0.30930901877063194, - "target_points": 4324, - "source_points": 4252 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8912040089674271, - "inlier_rmse_m": 0.1664031156014528, - "target_points": 7825, - "source_points": 7583 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8036719254543777, - "inlier_rmse_m": 0.1104629506267423, - "target_points": 11252, - "source_points": 10839 - } - ], - "heldout_symmetric": { - "evaluated": 8412, - "inliers": 6975, - "inlier_ratio": 0.829172610556348, - "inlier_rmse_m": 0.101007907265047, - "median_m": 0.08608358189900114, - "p90_m": 0.4058807146356751, - "p95_m": 0.7163687805230554 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3785.603273458994, - 7604.464366247825, - 8286.505868456072, - 8711.000000000002, - 11207.264352043558, - 14411.225085490601 - ], - "effective_rank": 6, - "scaled_condition_number": 3.8068503338763042, - "weakest_scaled_direction": [ - 0.6054069304441465, - -0.7595734962813032, - -0.012164644446449562, - 0.10293736986816451, - 0.07885905780967997, - 0.1989163659146241 - ] - }, - "forward_reverse": { - "translation_m": 0.002050657211153992, - "rotation_deg": 0.060432422726630436 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.130909444985391e-16, - "rotation_deg": 1.637183826880459e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 43788, - "frame_counter_j": 46130, - "rtk_translation_m": 7.378510482049102, - "rtk_rotation_deg": 138.09914998778677, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7451157370831191, - 0.6668773205806605, - 0.00878508088978908, - -8.591349732558395 - ], - [ - -0.6669016404366634, - -0.7451457281784634, - 0.0002139165133571026, - -4.658529365948349 - ], - [ - 0.006688821567984114, - -0.0056993922962447685, - 0.9999613875512816, - -0.07480835051829031 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4813, - "backend_objective": 75.12132230815749, - "backend_elapsed_sec": 0.22271739999996498, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.668026101141925, - "inlier_rmse_m": 0.49324589328657314, - "target_points": 4324, - "source_points": 3678 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5315328054298643, - "inlier_rmse_m": 0.20254753060141362, - "target_points": 7825, - "source_points": 7072 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4521796317173995, - "inlier_rmse_m": 0.12493199671780346, - "target_points": 11252, - "source_points": 10644 - } - ], - "heldout_symmetric": { - "evaluated": 8424, - "inliers": 4547, - "inlier_ratio": 0.5397673314339981, - "inlier_rmse_m": 0.12193285407050827, - "median_m": 0.2034385136534705, - "p90_m": 2.3529078752721992, - "p95_m": 4.369415466212758 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 955.2129060958863, - 1888.890089202048, - 2197.309734600416, - 4813.0, - 8520.322656408445, - 9126.438131133244 - ], - "effective_rank": 6, - "scaled_condition_number": 9.554349687793176, - "weakest_scaled_direction": [ - 0.9370972295870569, - 0.2219642120747634, - 0.009958731563809777, - -0.01654798973084987, - 0.058091788650524244, - 0.2623604441435154 - ] - }, - "forward_reverse": { - "translation_m": 2.3478431587463846, - "rotation_deg": 1.5786016001583607 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.950901565764194e-15, - "rotation_deg": 2.8165883232236616e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 43788, - "frame_counter_j": 47324, - "rtk_translation_m": 8.396001985859645, - "rtk_rotation_deg": 161.15751666826222, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9448743957762855, - 0.32735192478839764, - 0.007286531666753409, - -9.755290931122259 - ], - [ - -0.32730361604614094, - -0.9448926631089579, - 0.007085063583398168, - -4.784931624277646 - ], - [ - 0.009204299512699948, - 0.004309587009436759, - 0.9999483528314291, - 0.005414203237941994 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4568, - "backend_objective": 74.3297390848701, - "backend_elapsed_sec": 0.21698110000579618, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.6317969963749352, - "inlier_rmse_m": 0.5068613217929956, - "target_points": 4324, - "source_points": 3862 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5041322314049587, - "inlier_rmse_m": 0.20865775688574142, - "target_points": 7825, - "source_points": 7139 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4284776287402683, - "inlier_rmse_m": 0.12756110026391565, - "target_points": 11252, - "source_points": 10661 - } - ], - "heldout_symmetric": { - "evaluated": 8303, - "inliers": 4189, - "inlier_ratio": 0.5045164398410213, - "inlier_rmse_m": 0.12642928247376978, - "median_m": 0.24330618453333341, - "p90_m": 2.666705650048876, - "p95_m": 4.971019558321518 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1029.5774289576138, - 1724.3739005010686, - 1961.4886149370088, - 4568.0, - 8829.470434823135, - 9593.238115557466 - ], - "effective_rank": 6, - "scaled_condition_number": 9.31764609998303, - "weakest_scaled_direction": [ - 0.8939789966503134, - 0.07715318181969466, - 0.016645610293390654, - -0.013359994997258496, - 0.06058216161117509, - 0.43671864623501855 - ] - }, - "forward_reverse": { - "translation_m": 0.020394024193417442, - "rotation_deg": 0.4096021180283358 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1545593851848194e-14, - "rotation_deg": 5.84600464091439e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 45217, - "frame_counter_j": 46130, - "rtk_translation_m": 8.925911734961222, - "rtk_rotation_deg": 77.12819998782052, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.21707135656365648, - 0.9757793945489054, - -0.027103493010799985, - -1.7568359165035279 - ], - [ - -0.975846971563542, - 0.21761733348900283, - 0.019115026952642843, - -10.169870008703967 - ], - [ - 0.024550239303883944, - 0.02229953674202176, - 0.9994498568768787, - -0.032735880986101154 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4852, - "backend_objective": 83.39948860717325, - "backend_elapsed_sec": 0.29532599999947706, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7036432843936922, - "inlier_rmse_m": 0.5040588997389455, - "target_points": 4252, - "source_points": 3678 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5504807692307693, - "inlier_rmse_m": 0.20644516917131903, - "target_points": 7583, - "source_points": 7072 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4558436677940624, - "inlier_rmse_m": 0.13110561669985787, - "target_points": 10839, - "source_points": 10644 - } - ], - "heldout_symmetric": { - "evaluated": 8428, - "inliers": 4397, - "inlier_ratio": 0.5217133364973896, - "inlier_rmse_m": 0.12674065647229513, - "median_m": 0.22296345041507507, - "p90_m": 2.2436709216336665, - "p95_m": 4.225774589388734 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1198.2718177602899, - 1650.138016240725, - 2079.5884498523847, - 4852.000000000001, - 9485.792007140602, - 10211.898715200405 - ], - "effective_rank": 6, - "scaled_condition_number": 8.522188842167411, - "weakest_scaled_direction": [ - -0.3093880092751264, - -0.9335515582036054, - -0.025547066953758742, - 0.09066332561224451, - -0.025876863258506393, - -0.15237599745131963 - ] - }, - "forward_reverse": { - "translation_m": 0.029506475723043876, - "rotation_deg": 0.11389243918851435 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.973770779879594e-15, - "rotation_deg": 1.1322067867161058e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 45217, - "frame_counter_j": 47324, - "rtk_translation_m": 9.936139535050964, - "rtk_rotation_deg": 100.18656666829587, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.17668924576723757, - 0.9837883108289075, - -0.030683381603231565, - -2.2221723233462245 - ], - [ - -0.9841738297783874, - -0.176158510693766, - 0.0192367328175653, - -11.245879492585246 - ], - [ - 0.01351973407818584, - 0.03359670499556555, - 0.9993440239496584, - 0.016996536478614432 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4475, - "backend_objective": 78.30512325758481, - "backend_elapsed_sec": 0.7133050999982515, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.5673226307612635, - "inlier_rmse_m": 0.6013368102476768, - "target_points": 4252, - "source_points": 3862 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.39795489564364755, - "inlier_rmse_m": 0.25878033356001845, - "target_points": 7583, - "source_points": 7139 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.41975424444236, - "inlier_rmse_m": 0.13228133491139535, - "target_points": 10839, - "source_points": 10661 - } - ], - "heldout_symmetric": { - "evaluated": 8307, - "inliers": 4112, - "inlier_ratio": 0.49500421331407246, - "inlier_rmse_m": 0.12930714939449198, - "median_m": 0.25660286926885856, - "p90_m": 2.409787759567327, - "p95_m": 4.515512558205435 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1144.397556185211, - 1500.2570670753455, - 1815.8097258657588, - 4475.0, - 9399.69361913362, - 10202.284056462451 - ], - "effective_rank": 6, - "scaled_condition_number": 8.914982386428042, - "weakest_scaled_direction": [ - 0.5105661947909619, - 0.7109710419935402, - 0.04024744174669834, - -0.0933740005656362, - 0.040389434768684486, - 0.4710334077255864 - ] - }, - "forward_reverse": { - "translation_m": 0.09268316078142827, - "rotation_deg": 0.5769686714189283 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3558392721549323e-14, - "rotation_deg": 3.8960173286595167e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 45217, - "frame_counter_j": 48071, - "rtk_translation_m": 9.719184595429152, - "rtk_rotation_deg": 159.1482027457047, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9501646829894342, - 0.30616222353634714, - -0.05875174958132426, - -3.0918982038138227 - ], - [ - -0.3075461046772382, - -0.9513995616855612, - 0.015945768165234252, - -10.151609559213941 - ], - [ - -0.05101439696246861, - 0.03321997748045168, - 0.998145262173174, - -0.13371320197691594 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4552, - "backend_objective": 81.04952499081672, - "backend_elapsed_sec": 0.2594355000037467, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.6813804173354735, - "inlier_rmse_m": 0.48940315515327115, - "target_points": 4252, - "source_points": 3738 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5367029334802369, - "inlier_rmse_m": 0.21723311287318103, - "target_points": 7583, - "source_points": 7261 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.41719365777655576, - "inlier_rmse_m": 0.13343633661578574, - "target_points": 10839, - "source_points": 10911 - } - ], - "heldout_symmetric": { - "evaluated": 8339, - "inliers": 4127, - "inlier_ratio": 0.4949034656433625, - "inlier_rmse_m": 0.12826034683961704, - "median_m": 0.2581899701761212, - "p90_m": 2.3338351988117467, - "p95_m": 4.184320508119737 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1057.1727991881346, - 1784.4345562325352, - 2058.8437584201392, - 4551.999999999999, - 9270.63433835936, - 10027.083468818624 - ], - "effective_rank": 6, - "scaled_condition_number": 9.48481031343127, - "weakest_scaled_direction": [ - 0.4462039866604823, - 0.8224804029348536, - 0.037715343544755225, - -0.09390930550180605, - 0.03553737888903208, - 0.33604118643341996 - ] - }, - "forward_reverse": { - "translation_m": 0.046228293643484374, - "rotation_deg": 0.3497292020413176 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 4.920978084198686, - "rotation_deg": 2.2404785233351188 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "multistart_instability" - ] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 46130, - "frame_counter_j": 47324, - "rtk_translation_m": 1.0176267260390144, - "rtk_rotation_deg": 23.058366680475352, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9223076839989442, - 0.3864546577504997, - -0.0011547897851938635, - 0.9490101814708993 - ], - [ - -0.3864475310870574, - 0.9222622155568105, - -0.009524257081881033, - -0.6860164798066205 - ], - [ - -0.0026156745251108434, - 0.00923056115241296, - 0.9999539764347106, - 0.010887219415158708 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8552, - "backend_objective": 103.0785205986991, - "backend_elapsed_sec": 0.2248606000066502, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9251683065769032, - "inlier_rmse_m": 0.27203749754837164, - "target_points": 3678, - "source_points": 3862 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8921417565485362, - "inlier_rmse_m": 0.1703432323836039, - "target_points": 7072, - "source_points": 7139 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.802176156082919, - "inlier_rmse_m": 0.10978682922687369, - "target_points": 10644, - "source_points": 10661 - } - ], - "heldout_symmetric": { - "evaluated": 8319, - "inliers": 6957, - "inlier_ratio": 0.8362783988460152, - "inlier_rmse_m": 0.09839553390448733, - "median_m": 0.07716828631352049, - "p90_m": 0.3795477067663131, - "p95_m": 0.7362003663423657 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2710.4187386843732, - 4669.656265459002, - 6761.812258340721, - 8551.999999999996, - 8891.685049618896, - 9450.309841560995 - ], - "effective_rank": 6, - "scaled_condition_number": 3.4866604582833345, - "weakest_scaled_direction": [ - 0.8349303370187887, - -0.512076575992112, - -0.013692109535836213, - 0.04513679189638587, - 0.06868415723260546, - 0.18364802025857557 - ] - }, - "forward_reverse": { - "translation_m": 0.00292801654357991, - "rotation_deg": 0.07029435398214784 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5503526729519554e-15, - "rotation_deg": 3.12648856888935e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 46130, - "frame_counter_j": 48071, - "rtk_translation_m": 0.8427696971904044, - "rtk_rotation_deg": 82.02000275788396, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.09291671584343741, - 0.9956556615780775, - -0.00602390939433363, - -0.3071777403337689 - ], - [ - -0.9951851598036602, - 0.09267987004380085, - -0.03188948722113763, - -1.280598057914212 - ], - [ - -0.031192653356724956, - 0.008957971655762058, - 0.9994732478262642, - -0.009165640225914548 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8981, - "backend_objective": 108.1496393783755, - "backend_elapsed_sec": 0.20221830000082264, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9371321562332798, - "inlier_rmse_m": 0.3031495077997656, - "target_points": 3678, - "source_points": 3738 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8968461644401597, - "inlier_rmse_m": 0.16236043291512026, - "target_points": 7072, - "source_points": 7261 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.823114288332875, - "inlier_rmse_m": 0.10973626884676393, - "target_points": 10644, - "source_points": 10911 - } - ], - "heldout_symmetric": { - "evaluated": 8351, - "inliers": 7172, - "inlier_ratio": 0.8588193030774758, - "inlier_rmse_m": 0.09922846236206209, - "median_m": 0.0753204926350975, - "p90_m": 0.342546232933198, - "p95_m": 0.6746352059992454 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2927.3028816190645, - 5306.129149420016, - 7082.01848820748, - 8980.999999999998, - 9614.916613017844, - 10728.727976344777 - ], - "effective_rank": 6, - "scaled_condition_number": 3.665055653691297, - "weakest_scaled_direction": [ - 0.7018743003599516, - -0.6510207286650349, - -0.02015795038749125, - 0.0642255684298273, - 0.06074446735944279, - 0.2744509435653927 - ] - }, - "forward_reverse": { - "translation_m": 0.007868521232743847, - "rotation_deg": 0.0646663588791515 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7625164985270986e-16, - "rotation_deg": 3.4431691728129735e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 46130, - "frame_counter_j": 48989, - "rtk_translation_m": 1.1320092061720382, - "rtk_rotation_deg": 147.1799498371321, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8402222353462306, - 0.5410101636700885, - -0.03653215070931447, - -1.287628019683023 - ], - [ - -0.5400402944256152, - -0.8409743777127718, - -0.03344512561364011, - -0.3955067570916354 - ], - [ - -0.04881675559147709, - -0.008372504779468987, - 0.9987726595863734, - -0.03727470967151131 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8574, - "backend_objective": 106.26210435646232, - "backend_elapsed_sec": 0.5397340999988955, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9245377311344328, - "inlier_rmse_m": 0.331505131955258, - "target_points": 3678, - "source_points": 4002 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8562228939413852, - "inlier_rmse_m": 0.17104227887804455, - "target_points": 7072, - "source_points": 7609 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7632188000712123, - "inlier_rmse_m": 0.11132622085573071, - "target_points": 10644, - "source_points": 11234 - } - ], - "heldout_symmetric": { - "evaluated": 8417, - "inliers": 6721, - "inlier_ratio": 0.7985030295829868, - "inlier_rmse_m": 0.09950089003213429, - "median_m": 0.08291449146155523, - "p90_m": 0.5613010098206155, - "p95_m": 0.9802203045432637 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2653.4038203284463, - 4839.470013007292, - 6360.850538473196, - 8574.0, - 9558.678186522648, - 10646.561300778201 - ], - "effective_rank": 6, - "scaled_condition_number": 4.012416511656465, - "weakest_scaled_direction": [ - 0.6869769534391204, - -0.6675262593060802, - -0.004470693004566057, - 0.05916352696817023, - 0.059047631928164195, - 0.27470789163174497 - ] - }, - "forward_reverse": { - "translation_m": 0.002818384349407474, - "rotation_deg": 0.04751878128625789 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.029579020909896e-15, - "rotation_deg": 2.6611437468197602e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 47324, - "frame_counter_j": 48071, - "rtk_translation_m": 0.2771314063233405, - "rtk_rotation_deg": 58.9616360774086, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.47036026521744956, - 0.8824688813623645, - 0.003145525652094919, - -0.9264987432290289 - ], - [ - -0.882184149378728, - 0.4702939538802801, - -0.023973392095892873, - -1.036326827226633 - ], - [ - -0.02263509420127949, - 0.008501198192643753, - 0.9997076483351462, - -0.01421015956088072 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9037, - "backend_objective": 104.3929089659468, - "backend_elapsed_sec": 0.2702939000009792, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9604066345639379, - "inlier_rmse_m": 0.2841682265181672, - "target_points": 3862, - "source_points": 3738 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9143368681999725, - "inlier_rmse_m": 0.1645629592250296, - "target_points": 7139, - "source_points": 7261 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8282467234900559, - "inlier_rmse_m": 0.10747893605684278, - "target_points": 10661, - "source_points": 10911 - } - ], - "heldout_symmetric": { - "evaluated": 8230, - "inliers": 7047, - "inlier_ratio": 0.8562575941676792, - "inlier_rmse_m": 0.09641015722415121, - "median_m": 0.07264881713169018, - "p90_m": 0.3649111694279329, - "p95_m": 0.5949589335848491 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3360.519453987095, - 4686.232961934681, - 7090.35102954367, - 9037.0, - 9698.309888852362, - 10577.545001503502 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1475922536183365, - "weakest_scaled_direction": [ - 0.904658889778098, - -0.3634829302819726, - -0.011844469019818052, - 0.035751364107884834, - 0.08236029230619624, - 0.20315211864115965 - ] - }, - "forward_reverse": { - "translation_m": 0.00743603397476557, - "rotation_deg": 0.05749362415769439 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2216900154264712e-15, - "rotation_deg": 1.306320930863249e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 47324, - "frame_counter_j": 48989, - "rtk_translation_m": 0.5409306841643147, - "rtk_rotation_deg": 124.12158315665668, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.566108359425634, - 0.8239680491840554, - -0.024453615524915553, - -2.1753331114145316 - ], - [ - -0.8231688822669846, - -0.5666361133611528, - -0.03628369196058778, - -0.5953246126004527 - ], - [ - -0.04375290454062678, - -0.00041104597068210774, - 0.9990422985967461, - -0.052576135977120866 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8306, - "backend_objective": 100.52583704896757, - "backend_elapsed_sec": 0.24529099999926984, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9197901049475262, - "inlier_rmse_m": 0.3317889796124115, - "target_points": 3862, - "source_points": 4002 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8454461821527139, - "inlier_rmse_m": 0.1791573409950583, - "target_points": 7139, - "source_points": 7609 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7393626491009435, - "inlier_rmse_m": 0.11001271572903071, - "target_points": 10661, - "source_points": 11234 - } - ], - "heldout_symmetric": { - "evaluated": 8296, - "inliers": 6300, - "inlier_ratio": 0.7594021215043394, - "inlier_rmse_m": 0.09971190839470828, - "median_m": 0.08930995018821405, - "p90_m": 0.6464965987550457, - "p95_m": 1.3971767447422603 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2850.9496922544977, - 4432.486299822851, - 5881.527273728982, - 8306.000000000004, - 9845.087061905926, - 11189.810920205255 - ], - "effective_rank": 6, - "scaled_condition_number": 3.924941555652805, - "weakest_scaled_direction": [ - 0.7649081936999556, - -0.5371000410105018, - 0.001918083380795508, - 0.05159331998232335, - 0.07470409853324168, - 0.34379172344439995 - ] - }, - "forward_reverse": { - "translation_m": 0.008658288176145966, - "rotation_deg": 0.04699249624411687 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6912690955031143e-15, - "rotation_deg": 3.862697552826486e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 34, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 47324, - "frame_counter_j": 49755, - "rtk_translation_m": 0.9901318542574941, - "rtk_rotation_deg": 155.5976733552555, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9130159503406957, - 0.4059989618272669, - -0.03958178139828122, - -1.9322409640198592 - ], - [ - -0.40525824035830116, - -0.9138442538191438, - -0.025581993343463966, - 0.2508316373488746 - ], - [ - -0.046557846225663085, - -0.007315924884377673, - 0.998888804721483, - -0.04350500783623803 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8149, - "backend_objective": 91.79725226205142, - "backend_elapsed_sec": 0.4766929000033997, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.912621359223301, - "inlier_rmse_m": 0.3358802528697239, - "target_points": 3862, - "source_points": 3605 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8481815618832816, - "inlier_rmse_m": 0.16869638046321433, - "target_points": 7139, - "source_points": 7094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7581170341427109, - "inlier_rmse_m": 0.10613599165810188, - "target_points": 10661, - "source_points": 10749 - } - ], - "heldout_symmetric": { - "evaluated": 8296, - "inliers": 6494, - "inlier_ratio": 0.7827868852459017, - "inlier_rmse_m": 0.09387821156002771, - "median_m": 0.07875435259810891, - "p90_m": 0.6915015848974357, - "p95_m": 1.7028500865850456 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2848.915874810869, - 4207.789178220437, - 5913.187150162787, - 8149.000000000004, - 9403.46169976524, - 10477.657178931679 - ], - "effective_rank": 6, - "scaled_condition_number": 3.677769944550314, - "weakest_scaled_direction": [ - 0.877071193298773, - -0.4029984241934514, - 0.01195256835894956, - 0.03947503981671744, - 0.09305356723647489, - 0.24078679978088735 - ] - }, - "forward_reverse": { - "translation_m": 0.001760438169327793, - "rotation_deg": 0.07141137968742438 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 3.1508463809158345, - "rotation_deg": 7.292228684955787 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "multistart_instability" - ] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 48071, - "frame_counter_j": 48989, - "rtk_translation_m": 0.38765596924480794, - "rtk_rotation_deg": 65.15994707924807, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4607520487322902, - 0.8875289006887243, - -5.5913691085545284e-06, - -0.980694724875107 - ], - [ - -0.8871753732501487, - 0.4605683405636007, - -0.028225179697402483, - -0.8963585049897586 - ], - [ - -0.0250480875009855, - 0.013009769896391098, - 0.9996015902347225, - -0.038150651315160204 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9277, - "backend_objective": 104.45631312391384, - "backend_elapsed_sec": 0.22652519999974174, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9415292353823088, - "inlier_rmse_m": 0.28339378847311814, - "target_points": 3738, - "source_points": 4002 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8981469312656065, - "inlier_rmse_m": 0.15796415985902745, - "target_points": 7261, - "source_points": 7609 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8257966886238205, - "inlier_rmse_m": 0.10611177228017632, - "target_points": 10911, - "source_points": 11234 - } - ], - "heldout_symmetric": { - "evaluated": 8328, - "inliers": 7157, - "inlier_ratio": 0.859390009606148, - "inlier_rmse_m": 0.09596734045987164, - "median_m": 0.07591207678233595, - "p90_m": 0.3660628664095248, - "p95_m": 0.7752969121095461 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3649.066292791873, - 5030.80520815177, - 7175.832686931752, - 9277.0, - 10821.739523597167, - 12208.940819606056 - ], - "effective_rank": 6, - "scaled_condition_number": 3.3457711754162425, - "weakest_scaled_direction": [ - 0.7385391360467448, - 0.6643423249365958, - 9.599288630973953e-05, - -0.07684543472076581, - 0.085427529193792, - 0.0024752836106599206 - ] - }, - "forward_reverse": { - "translation_m": 0.007599187780672587, - "rotation_deg": 0.08086834965344242 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1558622765803136e-15, - "rotation_deg": 1.8132036814512305e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 48071, - "frame_counter_j": 49755, - "rtk_translation_m": 1.0327853226589305, - "rtk_rotation_deg": 96.63603727784675, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07124246018086076, - 0.9973535070925303, - -0.014508402999965673, - -1.6179090319792264 - ], - [ - -0.996572136437519, - -0.07178482513364683, - -0.04112074606440068, - -0.2799848551616359 - ], - [ - -0.04205340347391228, - 0.0115291270598719, - 0.9990488428928257, - -0.04406055172540374 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8515, - "backend_objective": 96.85504821477137, - "backend_elapsed_sec": 0.4268725000001723, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9140083217753121, - "inlier_rmse_m": 0.3002375032743752, - "target_points": 3738, - "source_points": 3605 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8662249788553708, - "inlier_rmse_m": 0.15705081666885246, - "target_points": 7261, - "source_points": 7094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7921667131826217, - "inlier_rmse_m": 0.10665195105069991, - "target_points": 10911, - "source_points": 10749 - } - ], - "heldout_symmetric": { - "evaluated": 8328, - "inliers": 6918, - "inlier_ratio": 0.8306916426512968, - "inlier_rmse_m": 0.09663160733562838, - "median_m": 0.0747317512257886, - "p90_m": 0.4730919564691816, - "p95_m": 1.15279231882915 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2889.8366113957095, - 4525.812953799511, - 6502.050038150041, - 8514.999999999998, - 9468.696671711426, - 10292.708325489693 - ], - "effective_rank": 6, - "scaled_condition_number": 3.561692133355112, - "weakest_scaled_direction": [ - 0.8036165607047068, - 0.5836919351580159, - 0.02478833002974586, - -0.05933777487585913, - 0.07934067754163421, - 0.05544161115066359 - ] - }, - "forward_reverse": { - "translation_m": 0.008708468398558678, - "rotation_deg": 0.031578495955716095 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.135936359693696e-16, - "rotation_deg": 5.543623079342332e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 35, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 48071, - "frame_counter_j": 50767, - "rtk_translation_m": 1.1947451269258382, - "rtk_rotation_deg": 131.6892972449946, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6226388031755216, - 0.7819955990836764, - -0.028351433718878265, - -1.726118049308828 - ], - [ - -0.7808339743232207, - -0.6232674026979902, - -0.042849145577320384, - 0.1497045792186773 - ], - [ - -0.05117836772268982, - -0.00454177805088336, - 0.998679201209967, - -0.04576880307242299 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8430, - "backend_objective": 88.50351238994902, - "backend_elapsed_sec": 0.6129135000010137, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7590266875981162, - "inlier_rmse_m": 0.491629549623818, - "target_points": 3738, - "source_points": 3822 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5559201531309816, - "inlier_rmse_m": 0.2281241862484838, - "target_points": 7261, - "source_points": 7314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7689501048982943, - "inlier_rmse_m": 0.10246285812030317, - "target_points": 10911, - "source_points": 10963 - } - ], - "heldout_symmetric": { - "evaluated": 8432, - "inliers": 6792, - "inlier_ratio": 0.8055028462998103, - "inlier_rmse_m": 0.09329597448562056, - "median_m": 0.07571541245907315, - "p90_m": 0.5509547235758097, - "p95_m": 1.3915059272843682 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3193.524099964195, - 4046.4650982464864, - 6284.721636124388, - 8430.0, - 9353.766409157171, - 10225.679554039567 - ], - "effective_rank": 6, - "scaled_condition_number": 3.202004817860687, - "weakest_scaled_direction": [ - 0.6766557746366936, - 0.7264271245371762, - 0.017668119327738756, - -0.07264823762268478, - 0.06922032267567903, - -0.06371195685175454 - ] - }, - "forward_reverse": { - "translation_m": 0.002684669665422271, - "rotation_deg": 0.0241000049832631 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.853849767289656e-15, - "rotation_deg": 2.6439440377165722e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 34, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 48989, - "frame_counter_j": 49755, - "rtk_translation_m": 0.7453275493729801, - "rtk_rotation_deg": 31.47609019859864, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8525789098448849, - 0.5225974934707407, - 0.0010306822053762785, - -0.8358647997403197 - ], - [ - -0.5224700837622841, - 0.8524114556787717, - -0.020487113047720863, - -0.27809682391240603 - ], - [ - -0.011585079246217619, - 0.016928379889919517, - 0.9997895858095148, - -0.02824796283151424 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8958, - "backend_objective": 104.56728759466449, - "backend_elapsed_sec": 0.30054959999688435, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.957004160887656, - "inlier_rmse_m": 0.2904647522413556, - "target_points": 4002, - "source_points": 3605 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9107696645052157, - "inlier_rmse_m": 0.1614393443497762, - "target_points": 7609, - "source_points": 7094 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8333798492883059, - "inlier_rmse_m": 0.10804194462759917, - "target_points": 11234, - "source_points": 10749 - } - ], - "heldout_symmetric": { - "evaluated": 8394, - "inliers": 7177, - "inlier_ratio": 0.8550154872527996, - "inlier_rmse_m": 0.09764473733600805, - "median_m": 0.07456086864199697, - "p90_m": 0.34241331181569223, - "p95_m": 0.6802566221374402 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3095.895584241593, - 4616.49196094853, - 7189.437190604422, - 8958.000000000002, - 9341.535200984368, - 9761.694001458443 - ], - "effective_rank": 6, - "scaled_condition_number": 3.153108280248987, - "weakest_scaled_direction": [ - -0.14956744297001207, - 0.9813228108110075, - -0.0010151349147909303, - -0.1042531181475832, - -0.01582831738650241, - 0.05928610471028017 - ] - }, - "forward_reverse": { - "translation_m": 0.005560284067502743, - "rotation_deg": 0.07666131775182662 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.861076153478991e-15, - "rotation_deg": 2.646807237305875e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 48989, - "frame_counter_j": 50767, - "rtk_translation_m": 1.0924186931915323, - "rtk_rotation_deg": 66.52935016574651, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.40679174337391777, - 0.9135194677359497, - 0.0016308250173089898, - -1.2736797341085286 - ], - [ - -0.9131799642647562, - 0.4066880362428154, - -0.026593120207716498, - -0.18719052476876435 - ], - [ - -0.02495657004133635, - 0.009328625000020867, - 0.9996450101748025, - -0.024365257755028975 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8880, - "backend_objective": 82.86119375144456, - "backend_elapsed_sec": 0.2115237999969395, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9510727367870225, - "inlier_rmse_m": 0.29581592010146796, - "target_points": 4002, - "source_points": 3822 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8915777960076565, - "inlier_rmse_m": 0.1567663887531643, - "target_points": 7609, - "source_points": 7314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8099972635227584, - "inlier_rmse_m": 0.09659821692220857, - "target_points": 11234, - "source_points": 10963 - } - ], - "heldout_symmetric": { - "evaluated": 8498, - "inliers": 7091, - "inlier_ratio": 0.8344316309719935, - "inlier_rmse_m": 0.08989959394950665, - "median_m": 0.06985128048619482, - "p90_m": 0.41116965276058887, - "p95_m": 0.674083247243687 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3205.219989574781, - 4888.185330605202, - 7538.936561692851, - 8880.000000000002, - 9206.228047832996, - 9661.436171661977 - ], - "effective_rank": 6, - "scaled_condition_number": 3.014281766333208, - "weakest_scaled_direction": [ - -0.16720484056921212, - 0.9778121030649397, - 0.005163028152377496, - -0.10736267227659853, - -0.01869381808778759, - 0.0634284896333691 - ] - }, - "forward_reverse": { - "translation_m": 0.0013737288250339052, - "rotation_deg": 0.028590963377823297 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2063302474774457e-15, - "rotation_deg": 1.0073042692452486e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 48989, - "frame_counter_j": 51951, - "rtk_translation_m": 3.335020341384374, - "rtk_rotation_deg": 123.21987515531416, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5323351777040894, - 0.846494631523009, - -0.008130029611099434, - -1.5574035969003905 - ], - [ - -0.8463265842768996, - -0.5323928258820109, - -0.017005637170118954, - 2.216958365775798 - ], - [ - -0.018723550009291576, - -0.002172038694094735, - 0.999822339679886, - 0.004130279058768138 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7485, - "backend_objective": 88.77970941233586, - "backend_elapsed_sec": 0.4440431999973953, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8808683853459973, - "inlier_rmse_m": 0.3456748590005254, - "target_points": 4002, - "source_points": 3685 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8051363900174114, - "inlier_rmse_m": 0.17368506843621886, - "target_points": 7609, - "source_points": 6892 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7256422685409598, - "inlier_rmse_m": 0.1089082945489211, - "target_points": 11234, - "source_points": 10315 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 6222, - "inlier_ratio": 0.7655961609449982, - "inlier_rmse_m": 0.10046425727734096, - "median_m": 0.08925063409513098, - "p90_m": 0.6542960337557067, - "p95_m": 1.1917515380041095 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2409.5341593735616, - 4558.680475937134, - 6740.117788964928, - 7485.0, - 7567.940398312457, - 7765.177775348541 - ], - "effective_rank": 6, - "scaled_condition_number": 3.222688396070449, - "weakest_scaled_direction": [ - 0.41067971586008273, - -0.9033129794651327, - 0.01436887864648022, - 0.08989060499137361, - 0.03968729180841041, - -0.07420219296320431 - ] - }, - "forward_reverse": { - "translation_m": 0.012544124903927084, - "rotation_deg": 0.05831564134554671 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.699297710836866e-15, - "rotation_deg": 3.670963258309652e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 35, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 49755, - "frame_counter_j": 50767, - "rtk_translation_m": 0.6186130964444055, - "rtk_rotation_deg": 35.05325996714787, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8242388431937798, - 0.5662385948737504, - 0.002045249613517558, - -0.4179872278727123 - ], - [ - -0.5662173516288463, - 0.824231065872823, - -0.006407867396094824, - -0.1470945887548201 - ], - [ - -0.0053141400994276165, - 0.004123557390310504, - 0.9999773778388452, - -0.01382406991588343 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9362, - "backend_objective": 89.20557014856486, - "backend_elapsed_sec": 0.26846150000346825, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9701726844583988, - "inlier_rmse_m": 0.2726347686650175, - "target_points": 3605, - "source_points": 3822 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9213836477987422, - "inlier_rmse_m": 0.15574298241610862, - "target_points": 7094, - "source_points": 7314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8539633312049622, - "inlier_rmse_m": 0.0976139008165204, - "target_points": 10749, - "source_points": 10963 - } - ], - "heldout_symmetric": { - "evaluated": 8498, - "inliers": 7387, - "inlier_ratio": 0.8692633560837845, - "inlier_rmse_m": 0.08711586696140278, - "median_m": 0.06845824353486515, - "p90_m": 0.3305822401274176, - "p95_m": 0.5814606995921776 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3583.500875157316, - 5450.111186010195, - 8204.243889904628, - 9362.000000000002, - 9704.264050882994, - 10473.863147812619 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9228018947680083, - "weakest_scaled_direction": [ - 0.7613963662569775, - -0.6154729024008196, - 0.016356809125864114, - 0.07908555706128505, - 0.09353455033031878, - -0.16185764490753277 - ] - }, - "forward_reverse": { - "translation_m": 0.006834102546614079, - "rotation_deg": 0.04740606842462777 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5162406088350824e-15, - "rotation_deg": 1.4865924008646322e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 49755, - "frame_counter_j": 51951, - "rtk_translation_m": 3.114273556969299, - "rtk_rotation_deg": 91.74378495671547, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.01114047818460611, - 0.999885079378662, - -0.010281915275994839, - -1.918506206398027 - ], - [ - -0.9999224933919975, - -0.011196876255580477, - -0.005444003200879246, - 1.743583795598014 - ], - [ - -0.0055585029056645485, - 0.01022046956072171, - 0.9999323202334288, - -0.030082336933715734 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7366, - "backend_objective": 82.11240101565183, - "backend_elapsed_sec": 0.49097469999833265, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8561736770691994, - "inlier_rmse_m": 0.33220617386256146, - "target_points": 3605, - "source_points": 3685 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7929483459082994, - "inlier_rmse_m": 0.17099939445457238, - "target_points": 7094, - "source_points": 6892 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7141056713523994, - "inlier_rmse_m": 0.10558166790867593, - "target_points": 10749, - "source_points": 10315 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 6268, - "inlier_ratio": 0.771256306140027, - "inlier_rmse_m": 0.09836949441930562, - "median_m": 0.08779633534298051, - "p90_m": 0.7174010192486797, - "p95_m": 1.5569151880467174 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2256.339257577384, - 4340.269190597313, - 5861.637989254067, - 7366.0, - 7736.23902975557, - 8436.346206192766 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7389528980898077, - "weakest_scaled_direction": [ - -0.5379899823848273, - 0.8063322773746366, - -0.030231101050797165, - -0.08557132960508067, - -0.048728349592079195, - 0.223123762388303 - ] - }, - "forward_reverse": { - "translation_m": 0.004832468349243269, - "rotation_deg": 0.046439990812924645 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.116760736506822e-15, - "rotation_deg": 1.2324515442136197e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 37, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 49755, - "frame_counter_j": 52792, - "rtk_translation_m": 2.8155528331227235, - "rtk_rotation_deg": 126.08390993626574, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.596396331556813, - 0.801835500471849, - -0.037030337409198893, - -2.204003646940688 - ], - [ - -0.8020534900677476, - -0.5971258376020329, - -0.012285484858782872, - 1.752154653181172 - ], - [ - -0.03196270914243542, - 0.02237329325625939, - 0.9992386206373071, - -0.03149336677809855 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6888, - "backend_objective": 78.07486244205103, - "backend_elapsed_sec": 0.5058562000049278, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8159917990773962, - "inlier_rmse_m": 0.34875107981820014, - "target_points": 3605, - "source_points": 3902 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7434229137199434, - "inlier_rmse_m": 0.17526473441173976, - "target_points": 7094, - "source_points": 7070 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6606560521772492, - "inlier_rmse_m": 0.10646553593967685, - "target_points": 10749, - "source_points": 10426 - } - ], - "heldout_symmetric": { - "evaluated": 8177, - "inliers": 5911, - "inlier_ratio": 0.722881252293017, - "inlier_rmse_m": 0.10001696647063055, - "median_m": 0.09592755660639098, - "p90_m": 1.3982957946185472, - "p95_m": 2.758753637125369 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1977.6445409371618, - 3461.9735955020087, - 5017.470752628317, - 6888.000000000001, - 7206.25322724712, - 7574.117936855115 - ], - "effective_rank": 6, - "scaled_condition_number": 3.8298681993003196, - "weakest_scaled_direction": [ - 0.6580940204747963, - -0.7247486182729003, - 0.03611368810859115, - 0.072040156903048, - 0.05650585037723261, - -0.17878704294373907 - ] - }, - "forward_reverse": { - "translation_m": 0.0035748664819913244, - "rotation_deg": 0.09211471145637762 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.53039199978758e-15, - "rotation_deg": 3.685458062869382e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "lidar_time_i": 1784259124.3419108, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 50767, - "frame_counter_j": 51951, - "rtk_translation_m": 2.4989423629184655, - "rtk_rotation_deg": 56.69052498956759, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5566333062621369, - 0.8306246820149684, - -0.014899663996757889, - -2.30205489676746 - ], - [ - -0.830742364465597, - 0.5566442009800575, - -0.0037891156462833537, - 0.7085191543109686 - ], - [ - 0.005146478581534595, - 0.014486930068409905, - 0.999881814323772, - -0.051970910966128804 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7462, - "backend_objective": 77.86855804588551, - "backend_elapsed_sec": 0.3732739000042784, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8664857530529172, - "inlier_rmse_m": 0.3182484976735445, - "target_points": 3822, - "source_points": 3685 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8019442832269298, - "inlier_rmse_m": 0.16718782059381235, - "target_points": 7314, - "source_points": 6892 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7234125060591372, - "inlier_rmse_m": 0.1021535453621509, - "target_points": 10963, - "source_points": 10315 - } - ], - "heldout_symmetric": { - "evaluated": 8231, - "inliers": 6336, - "inlier_ratio": 0.7697728101081278, - "inlier_rmse_m": 0.09462474495647087, - "median_m": 0.08134197356251517, - "p90_m": 0.7817855465677342, - "p95_m": 1.517032839344624 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2190.0878960037144, - 4363.673534965611, - 5737.588803936064, - 7462.0, - 7898.516123421373, - 8687.626030896494 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9667933176330195, - "weakest_scaled_direction": [ - 0.9520003505424035, - -0.12800989882648983, - 0.036974911432790844, - 0.02205143663945857, - 0.08892443995208017, - -0.25989965835963474 - ] - }, - "forward_reverse": { - "translation_m": 0.004833519542267701, - "rotation_deg": 0.07989067847153554 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.715703748492921e-16, - "rotation_deg": 3.4000766329772776e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "lidar_time_i": 1784259124.3419108, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 50767, - "frame_counter_j": 52792, - "rtk_translation_m": 2.2182956249874577, - "rtk_rotation_deg": 91.03064996911786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.03786801681658222, - 0.9986627789141708, - -0.03519470576384444, - -2.5418527005146974 - ], - [ - -0.9989885994102623, - -0.03868788327061707, - -0.022913444445624136, - 0.5531589803209176 - ], - [ - -0.024244412772897905, - 0.03429142311808659, - 0.9991177642049193, - -0.04844428377845549 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7189, - "backend_objective": 77.99482619396008, - "backend_elapsed_sec": 0.36426119999669027, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8241927216811892, - "inlier_rmse_m": 0.3388351281421605, - "target_points": 3822, - "source_points": 3902 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7504950495049505, - "inlier_rmse_m": 0.16360525406155269, - "target_points": 7314, - "source_points": 7070 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6895261845386533, - "inlier_rmse_m": 0.10415944460488373, - "target_points": 10963, - "source_points": 10426 - } - ], - "heldout_symmetric": { - "evaluated": 8281, - "inliers": 6088, - "inlier_ratio": 0.7351769110010868, - "inlier_rmse_m": 0.09626480689856566, - "median_m": 0.08963152661840915, - "p90_m": 1.497442598077857, - "p95_m": 2.891267199637511 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2300.535845571493, - 4153.780316463921, - 5709.28955641024, - 7189.000000000002, - 7580.590319548646, - 8293.164265162373 - ], - "effective_rank": 6, - "scaled_condition_number": 3.604883740945235, - "weakest_scaled_direction": [ - 0.9553378936188255, - -0.14663991300321066, - 0.0400285214671793, - 0.024239938206786812, - 0.09402075523542025, - -0.23408649123817582 - ] - }, - "forward_reverse": { - "translation_m": 0.00826951342075784, - "rotation_deg": 0.05772015666601106 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.54824382220464e-15, - "rotation_deg": 6.171120388649893e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 36, - "j": 37, - "lidar_time_i": 1784259242.7374756, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 51951, - "frame_counter_j": 52792, - "rtk_translation_m": 0.5129211474320938, - "rtk_rotation_deg": 34.34012497955026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8084384424499614, - 0.5885757258403574, - 0.002428934041470023, - 0.0014851318668930463 - ], - [ - -0.5883478617255572, - 0.8082277726916669, - -0.02479235875897221, - -0.2867627885921341 - ], - [ - -0.016555312502208895, - 0.018614037750192856, - 0.9996896714613933, - -0.008638216720072327 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9045, - "backend_objective": 88.28307663866053, - "backend_elapsed_sec": 0.2576998000004096, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9572014351614556, - "inlier_rmse_m": 0.24988301850131153, - "target_points": 3685, - "source_points": 3902 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.926025459688826, - "inlier_rmse_m": 0.1478611763849765, - "target_points": 6892, - "source_points": 7070 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8675426817571456, - "inlier_rmse_m": 0.09879488141931074, - "target_points": 10315, - "source_points": 10426 - } - ], - "heldout_symmetric": { - "evaluated": 7910, - "inliers": 6953, - "inlier_ratio": 0.8790139064475347, - "inlier_rmse_m": 0.08686306972783016, - "median_m": 0.06414233279846604, - "p90_m": 0.325357499937003, - "p95_m": 0.9888044814989764 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3890.655448966886, - 5640.769319940368, - 7986.380199775899, - 9044.999999999998, - 9649.700637839462, - 11143.581572303123 - ], - "effective_rank": 6, - "scaled_condition_number": 2.86419132160936, - "weakest_scaled_direction": [ - 0.9321425342082751, - 0.2616648534751975, - 0.00023735787791715921, - -0.0319236798691117, - 0.11392347763311746, - -0.22055399326334293 - ] - }, - "forward_reverse": { - "translation_m": 0.0018743847744752261, - "rotation_deg": 0.0426177033120738 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.16912472317716e-15, - "rotation_deg": 6.36935989850671e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - } - ] -} diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch2_estimation.npz b/results/01_previous_two_batches/open3d_gicp/B_batch2_estimation.npz deleted file mode 100644 index 80607ec..0000000 Binary files a/results/01_previous_two_batches/open3d_gicp/B_batch2_estimation.npz and /dev/null differ diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.csv b/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.csv deleted file mode 100644 index 85953ae..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.csv +++ /dev/null @@ -1,109 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,0.503306788400079,13.198324485965863,0.7947725072604066,0.09714510386272111,6,3.1645559924308744,0.00040681040655899406,0.015836974306118006,1.0,True, -0,2,1.1601020961002007,26.306295080591493,0.8196783588704571,0.10111548255452249,6,3.1496351272437915,0.0024786662018318395,0.04305117802148083,1.0,True, -0,3,1.1328421148283978,41.74134818989305,0.8170202208162759,0.10132889132333661,6,2.9636847958606816,0.001763337668740155,0.0152261810177797,1.0,True, -1,2,0.6927979865343085,13.107970594625625,0.7847728726807421,0.08513837010948266,6,2.6465075635845983,0.003621881376895638,0.011153493139183525,1.0,True, -1,3,0.7002295454253883,28.543023703927183,0.7885699962401304,0.09713251502799032,6,2.6341764735488145,0.0014094469663425105,0.02902143941632062,1.0,True, -1,4,0.8045641659338967,57.731023816949346,0.7363658899355479,0.09863727794945644,6,2.7377680197189993,0.011592408190980286,0.17084480097436408,1.0,True, -2,3,0.13949776780243606,15.435053109301553,0.918286915396742,0.07288259780013887,6,2.6383381348446657,0.002273707715582919,0.0026923349652342365,1.0,True, -2,4,0.6701726006967371,44.62305322232371,0.8370341514089079,0.09441127521663696,6,3.0939727970407334,0.0041401597740440875,0.03075174550917053,1.0,True, -2,5,0.8004226998626774,62.96656300910673,0.8235371293623721,0.10626795357026747,6,2.8027866429960917,0.009148796674106823,0.05256412309062332,1.0,True, -3,4,0.5366157827594368,29.188000113022152,0.8850603941513032,0.07613142655207121,6,2.6417590251999084,0.0013904645484531576,0.0259404694028417,1.0,True, -3,5,0.6760093701980526,47.53150989980517,0.8740046236835346,0.09072202522560696,6,2.686157540984516,0.006509933107990933,0.02545212192512678,1.0,True, -3,6,1.4361364806393455,80.09091141471853,0.6795928884308168,0.10271649349323747,6,3.008166890660092,0.00828154435242913,0.026486510290724834,1.0,True, -4,5,0.17861948949299924,18.343509786783002,0.8684444444444445,0.0784387700526441,6,2.6861954442048104,0.0025072579888539386,0.021042298559759365,1.0,True, -4,6,1.5807073315069207,50.90291130169636,0.6781301745000636,0.10313081772493418,6,2.8455217243212387,0.003271195715147848,0.14716032493381534,1.0,True, -4,7,1.7804201387535592,75.18775779751417,0.7873548387096774,0.09891997778736471,6,3.1802938248442474,0.004633577062239209,0.04472721629193465,1.0,True, -5,6,1.5316987521992935,32.55940151491337,0.6911991765311374,0.10152400788085783,6,3.2393513551418907,0.005288907067525738,0.05494235971756111,1.0,True, -5,7,1.6091514152462776,56.844248010731185,0.7747360187719984,0.09121609616459708,6,3.123473300580222,0.00421464356720393,0.015634168997181876,1.0,True, -5,8,1.1872485760158462,85.67585439000777,0.7829477514946712,0.10577559680144696,6,3.109219016133088,0.0033105282814613057,0.030813019102438145,1.0,True, -6,7,1.5692385974903325,24.284846495817817,0.7347979599843075,0.10196810239533251,6,3.458846242963224,0.004020707752206965,0.039850323489805044,1.0,True, -6,8,0.5035712140385419,53.11645287509441,0.7155149934810952,0.10460245111398395,6,3.0180670962260874,0.0072368624874882504,0.0055907688631446776,1.0,True, -6,9,0.8508108569116883,66.44324365209327,0.6825438366919655,0.10495957402394829,6,3.140616320789838,0.00430894236478819,0.13911475434755866,1.0,True, -7,8,1.1230406357307108,28.831606379276582,0.8127890077949531,0.09942756972076687,6,2.9436564519387325,0.008316114154115147,0.01814737917470093,1.0,True, -7,9,0.7186795671679719,42.158397156275456,0.8193873491579367,0.09507291602212191,6,3.5012345051117295,0.006751593996528964,0.029293578235221863,1.0,True, -7,10,0.39293571356254015,58.25702665650087,0.7940216681895313,0.10356080767641777,6,2.817840996766873,0.006883567504360684,0.016492683422577963,1.0,True, -8,9,0.4407680716864947,13.326790776998866,0.8581438392384981,0.09484304022144129,6,3.219825075793889,0.007253035671159373,0.024252719250072975,1.0,True, -8,10,0.968166048306331,29.425420277224287,0.8015356585111921,0.10152298131640612,6,3.7446585062478155,0.0017523919908150464,0.05042176209078739,1.0,True, -8,11,3.0540124804140354,66.34511043540417,0.688687555052221,0.10536230082368817,6,4.696625415382456,0.0036281146181207165,0.013078005975049522,1.0,True, -9,10,0.5276649044820116,16.098629500225417,0.8560606060606061,0.09594368034796862,6,3.2778548903058375,0.010491037599418197,0.0599937188173442,1.0,True, -9,11,2.680593454060616,53.0183196584053,0.6966788735951509,0.10384409271666459,6,4.3419055531595605,0.009543265092514783,0.09977883713501384,1.0,True, -9,12,3.2944321799753977,73.22024906015783,0.6579243162233046,0.10621203405076814,6,4.293885241325807,0.0028782078295197843,0.0743495992598884,1.0,True, -10,11,2.249454986440387,36.91969015817989,0.729195173529046,0.10869447817964137,6,4.322382098282597,0.0028206125960216254,0.014140069566934874,1.0,True, -10,12,2.8783779741216167,57.12161955993242,0.6945982527377876,0.10596349826421764,6,4.493186221276381,0.005660464094292755,0.08952914345108036,1.0,True, -10,13,3.84803303865234,78.07081297783375,0.6530587074494326,0.1098871098886565,6,4.997105968288151,0.009441275754405344,0.06902225135435515,1.0,True, -11,12,0.636223282239137,20.20192940175253,0.865792610250298,0.09248705530398661,6,3.4380496057859116,0.007654923324833218,0.03083951917063289,1.0,True, -11,13,2.0145868546459504,41.151122819653864,0.8217656194003106,0.10443913508460159,6,3.957969004992005,0.0019958122994113434,0.04243931133970266,1.0,True, -11,14,1.2405786051647103,116.67752660647822,0.7462918660287081,0.10754571546972236,6,4.619857754383166,0.0030226348073827927,0.05528144266002643,1.0,True, -12,13,1.5928240921286525,20.949193417901323,0.8347322378531742,0.10791137431619166,6,3.358528082155117,0.0033753816186126483,0.015427430722607398,1.0,True, -12,14,0.6774809171975742,96.47559720472566,0.7626657196969697,0.10926443071446633,6,3.847953795189004,0.0011083901763643633,0.03408686226954418,1.0,True, -12,15,1.8892292086221258,131.14857460490867,0.7404945183111733,0.10470183850479874,6,3.1806996321008576,0.008442575945215317,0.02844707164454242,1.0,True, -13,14,0.9721300146850552,75.52640378682433,0.8138569225293629,0.1125369920515294,6,3.2147734820704015,0.005457899756974233,0.04250371025579654,1.0,True, -13,15,2.426469315960194,110.19938118700728,0.7853886616014026,0.10710393317615087,6,2.4365756135744383,0.0023363953219779758,0.003679886698275418,1.0,True, -13,16,4.157137927296689,135.66277163100625,0.7461059190031153,0.10791684095774041,6,2.2141337125272007,0.0023169831632091926,0.02473862097872449,1.0,True, -14,15,2.176233486689304,34.672977400182965,0.7456694756554307,0.11049010248131722,6,2.3376174680383377,0.0027632919724097076,0.05272762900968177,1.0,True, -14,16,3.79947855245853,60.13636784418198,0.7114577084583084,0.11170286188791147,6,2.479974772421199,0.0043726035924820505,0.11525585711885118,1.0,True, -14,17,6.190474035537447,15.261944565117341,0.6170986278878855,0.11803645680912848,6,5.206426513766648,0.02802927019183766,0.10048860643286558,1.0,True, -15,16,1.7328875589135755,25.463390443999018,0.7687034629476421,0.09834033850996364,6,2.3729567416081196,0.004926598691892943,0.10049788043616295,1.0,True, -15,17,8.352264787019024,19.411032835065622,0.5596902808274586,0.12817180913542037,6,8.442537153126064,0.04660873899639204,0.08128930035257874,1.0,True, -15,18,6.346037230040679,25.592965647994788,0.6134687462217386,0.11861991782546771,6,5.933642175309751,0.006137337753783083,0.040498570689394164,1.0,True, -16,17,9.849975560032544,44.87442327906463,0.589649455234486,0.12715782204597983,6,10.240964391202342,0.016491489842564398,0.29283865924681673,1.0,True, -16,18,7.9099649541476005,0.12957520399577063,0.6441329694864798,0.11977657776801591,6,7.973620675877663,0.01581702082704062,0.07681086634765077,1.0,True, -16,19,6.609737623005951,34.172763646089344,0.642055375405338,0.11922626532224312,6,5.690723701436521,0.01936736899083179,0.22155509936605944,1.0,True, -17,18,2.081596655954183,45.003998483060414,0.761206687666586,0.10248796635270672,6,4.778521884225018,0.003602819302929225,0.04280787772842571,1.0,True, -17,19,4.34928579963815,79.047186925154,0.6654080389768575,0.10560001932239894,6,4.647516519431804,0.015683211248127868,0.18051709633786264,1.0,True, -17,20,4.4206846692505035,169.37257900760153,0.6377810007251632,0.11215519048187066,6,5.178731668470772,0.016926609942259613,0.20634229894075337,1.0,True, -18,19,3.459222336215112,34.04318844209358,0.7556208482370976,0.10994458141969204,6,3.594858191146124,0.004654350735545165,0.12873243616635754,1.0,True, -18,20,4.94806857498194,124.36858052454107,0.6686517992904207,0.11525187440612464,6,4.510107356424666,0.022993775653731053,0.1013964892640344,1.0,True, -18,21,6.5847443121227816,175.25342056617163,0.5905541093343251,0.1262853354637165,6,5.942345924349615,0.021857815102479028,0.4259066161744867,1.0,True, -19,20,3.031758915138065,90.32539208244746,0.7420998980632009,0.12052023632629244,6,3.3463968507926847,0.012566250876576632,0.08500209892702067,1.0,True, -19,21,3.732423384308353,141.21023212407198,0.6515019319456562,0.12055764747498063,6,4.076270140910382,0.007120603737667027,0.05561876226347328,1.0,True, -19,22,6.37255124464243,175.13200822775684,0.5905501782985226,0.12548545004843537,6,5.705777346141328,0.005772061596466365,0.10356450735473072,1.0,True, -20,21,2.057726146362386,50.884840041624386,0.7791517249907258,0.1109933103332085,6,3.525554312141476,0.004882992437392809,0.09954673132586826,1.0,True, -20,22,4.388457127616061,94.54259968980386,0.6575290550783224,0.11893104898070972,6,4.203674621017558,0.005511015274661758,0.13108161960065734,1.0,True, -20,23,8.256548639868363,126.4903843444735,0.5799237611181702,0.12732395079162134,6,6.120182481367245,0.02421237470645105,0.2728497258921342,1.0,True, -21,22,2.665930009787955,43.65775964817948,0.7379804721295267,0.11301282071283571,6,4.252070885311591,0.005342970038949662,0.023692959917636515,1.0,True, -21,23,6.670349114267683,75.60554430284907,0.6154133001864512,0.11796945645750438,6,5.503558762374886,0.021862964848253088,0.18671115674675795,1.0,True, -21,24,4.0761181240750135,118.87493116884215,0.6688601936925751,0.11271893154362743,6,4.6072424136923145,0.017882487871653564,0.11231417140662198,1.0,True, -22,23,4.005228418650323,31.947784654669576,0.7269494538989077,0.11696827793053062,6,3.9354343956207307,0.036708381465019306,0.17149160359500737,1.0,True, -22,24,1.4231800329066895,75.21717152066267,0.7625269567423569,0.11122908154278312,6,2.9923801902407035,0.033708002403797385,0.18898419347187523,1.0,True, -22,25,0.9824487562406952,165.63918634111403,0.7063042657606644,0.1109686247290255,6,3.260862218157852,0.0237546710240931,0.20388046327310663,1.0,True, -23,24,2.6253440212817054,43.26938686599312,0.785377057547531,0.11259637754562075,6,3.1689777161216344,0.008388924730327863,0.09824473511740778,1.0,True, -23,25,4.30404511575867,133.69140168644446,0.682445260093659,0.11585305930039552,6,4.459805342354154,0.03262070035564156,0.26820774135203534,1.0,True, -23,26,6.580252552934289,159.52196102005493,0.6190717727618564,0.1225437625254746,6,4.748664745468758,0.020450511219618477,0.11876511292532045,1.0,True, -24,25,2.0155105379126432,90.4220148204513,0.7662452591656131,0.10751986617832841,6,3.2073569479179214,0.020801978066425954,0.11499836231449187,1.0,True, -24,26,4.344602404326578,157.20865211395216,0.7051298290056998,0.11713046861462412,6,4.0423396253765445,0.02866879831073192,0.14020373652670878,1.0,True, -24,27,4.194437499675352,171.65485957819877,0.7231216797369087,0.11332956637109663,6,3.5737137574022637,0.0391123663878616,0.31745415833557195,1.0,True, -25,26,2.340922525153354,66.78663729350096,0.8146752104535746,0.1067005622933313,6,2.8555177924942416,0.015155094735859666,0.09937091691588736,1.0,True, -25,27,2.187150933555911,97.92312560134954,0.8480552070263488,0.10282262567757873,6,2.8008487935140383,0.020178532297188766,0.14259764688967286,1.0,True, -25,28,6.688406442287195,171.26720999836604,0.6516274978006786,0.11571138405667894,6,3.5101673009694134,0.012932261164889271,0.1340627397278959,1.0,True, -26,27,0.6349061963265976,31.136488307848563,0.8667504714016342,0.10966038141955464,6,2.9297274048756186,0.0016799531047772863,0.021489450960699312,1.0,True, -26,28,5.008419104260455,121.94615270813352,0.7044824981113069,0.11528623479803272,6,2.991781333569699,0.011526585390891731,0.12425176309998268,1.0,True, -26,29,2.224643201350574,145.73622267800252,0.713654161930024,0.11136018082941974,6,3.2605126809731075,0.0026952303885011083,0.026655596724504224,1.0,True, -27,28,5.622863551235285,90.80966440028486,0.7058971457311706,0.1123767383226778,6,3.2376046779603893,0.004853942846193662,0.04151426276015074,1.0,True, -27,29,2.458639091699311,114.59973437015381,0.7564328960645812,0.11469589052522192,6,3.205131133212321,0.012664149059349924,0.06847473063899887,1.0,True, -27,30,2.614522132166758,143.98503586800658,0.7694542698332492,0.10812761282109745,6,3.5636250205999853,0.029100131201629794,0.2714584305620497,1.0,True, -28,29,5.5254251571777075,23.790069969868927,0.6751737207833228,0.11779777341629802,6,4.576892329120707,0.02178556321929983,0.16690946122682282,1.0,True, -28,30,6.682895390289165,53.17537146772172,0.6491205871188156,0.12153627244194264,6,5.217063769204219,0.03128065038149053,0.11076032475862632,1.0,True, -28,31,11.27338119162288,23.882243944837096,0.5547279383916173,0.13098667045941628,6,8.538477868201968,0.007811024872033181,0.25693805699014277,1.0,True, -29,30,1.1998189814142899,29.3853014978528,0.8093424727088093,0.11457686827315132,6,2.757583581977887,0.011632920497220726,0.07792616982135933,1.0,True, -29,31,5.755712819539279,0.09217397496817598,0.7190982776089159,0.1179079898277715,6,4.190353867263325,0.010102013331328315,0.05295397679545269,1.0,True, -29,32,7.3497160995478215,44.7412737155501,0.683451384417257,0.12293657670032715,6,4.583568719289398,0.015683401555203327,0.1727804303986473,1.0,True, -30,31,4.592128513798009,29.29312752288462,0.7552004058853374,0.1130974670000902,6,3.6871413543680527,0.010357085925134528,0.12088315402655661,1.0,True, -30,32,6.2188831730504885,74.12657521340287,0.7014059073906874,0.11707558829895812,6,4.009905097582674,0.044382968752358344,0.22757601248033596,1.0,True, -30,33,7.344850966128434,112.7430048900433,0.6023929471032745,0.12334051659083738,6,4.260065691019417,0.002643716461244746,0.05342399356841621,1.0,True, -31,32,1.7043840283934533,44.83344769051828,0.785355810063055,0.11197405173054666,6,3.256332960817364,0.017947904056538493,0.11867936940390052,1.0,True, -31,33,3.3472002644811774,83.44987736715868,0.6260366926363408,0.11401170513833872,6,3.204107721135536,0.005088227871807909,0.05996016929359153,1.0,True, -31,34,3.311630046755356,133.49479301359594,0.6536974685122833,0.11166700866683012,6,3.289691648920709,0.01957685602042411,0.06586346108113965,1.0,True, -32,33,1.9394369188755196,38.61642967664041,0.7442187300370512,0.11487243540634488,6,2.5670787340169654,0.00371510987119075,0.04386474659625542,1.0,True, -32,34,2.1435446082722334,88.6613453230776,0.7408722109533469,0.1145103812359268,6,2.7396880211128143,0.0033854042879271646,0.04345206885157784,1.0,True, -32,35,3.1027737257249126,119.84526039487966,0.8249047681597268,0.10651397196801952,6,2.6908216879663684,0.014229552741777998,0.06789311177543367,1.0,True, -33,34,0.5704890065278277,50.0449156464372,0.8265015479876161,0.1079360614731508,6,3.0056080815747785,0.005517776656180037,0.04447304678975396,1.0,True, -33,35,2.3843314966611664,81.22883071823928,0.7029487179487179,0.11079043369762126,6,2.804837502264682,0.0045321280438173584,0.02066446888667937,1.0,True, -33,36,3.5605240220038255,106.66041349586102,0.612932138284251,0.11677728789370431,6,3.2326527799764184,0.011704878383874686,0.04254924292122366,1.0,True, -34,35,2.9403442697824866,31.183915071802076,0.7198829665436968,0.11381984857774002,6,3.296185466097946,0.015242618456135898,0.1219677981121258,1.0,True, -34,36,4.102710388907318,56.61549784942384,0.6450260449752255,0.11677131628998773,6,3.6854553885932066,0.0029445631740664846,0.0910859237401823,1.0,True, -34,37,3.6865711881345757,30.12086856551724,0.6870731404445548,0.11846537329500156,6,4.5399964456315365,0.013941395463696922,0.12307688004234886,1.0,True, -35,36,1.2045561534352058,25.431582777621774,0.811216429699842,0.11156358795429076,6,2.5821119008039335,0.003966448406861189,0.11486278330291146,1.0,True, -35,37,6.084062615492111,1.063046506284832,0.6916945230136282,0.12226449151266647,6,3.9062079497745845,0.012490325532322776,0.1588294259454204,1.0,True, -36,37,7.2781244258509386,26.494629283906598,0.6406009244992296,0.123972843683949,6,4.59789964279208,0.011995188628592031,0.19550165133048591,1.0,True, diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.json b/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.json deleted file mode 100644 index 6737012..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch2_quality.json +++ /dev/null @@ -1,13458 +0,0 @@ -{ - "schema_version": 2, - "backend": "open3d", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 38, - "candidate_pairs": 108, - "accepted_pairs": 108, - "parameters": { - "command": "pairs", - "backend": "open3d", - "frames": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_data1_20260720\\prepared\\frames_all", - "body": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_data1_20260720\\prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch2_estimation.npz", - "quality_json": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch2_quality.json", - "quality_csv": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\open3d_gicp\\B_batch2_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 25, - "min_gap": 1, - "max_gap": 3, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 40, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 1, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 106, - "translation_rms_m": 0.020350848901853437, - "translation_p95_m": 0.04464367942375473, - "rotation_rms_deg": 0.2674546762953808, - "rotation_p95_deg": 0.5761692075739222 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279429.4466305, - "frame_counter_i": 190, - "frame_counter_j": 1125, - "rtk_translation_m": 0.503306788400079, - "rtk_rotation_deg": 13.198324485965863, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9734962336098426, - 0.22869150395714602, - 0.002297643417305223, - -0.5126455200449422 - ], - [ - -0.22863457813529, - 0.9734014906396613, - -0.014689033371339515, - -0.4285040283413536 - ], - [ - -0.00559578666073166, - 0.013774397928947382, - 0.9998894704582818, - -0.015177554516289335 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8280, - "backend_objective": 96.77878203533326, - "backend_elapsed_sec": 0.47972870000376133, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8872773536895674, - "inlier_rmse_m": 0.2953605277253344, - "target_points": 4045, - "source_points": 3930 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8423465947403911, - "inlier_rmse_m": 0.16827360596674099, - "target_points": 7608, - "source_points": 7415 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7554055286926376, - "inlier_rmse_m": 0.10811225046182082, - "target_points": 11238, - "source_points": 10961 - } - ], - "heldout_symmetric": { - "evaluated": 8264, - "inliers": 6568, - "inlier_ratio": 0.7947725072604066, - "inlier_rmse_m": 0.09714510386272111, - "median_m": 0.08145908176917516, - "p90_m": 0.7506513799235621, - "p95_m": 1.956758597620319 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2985.067950597765, - 5263.101798271144, - 7386.6848181000605, - 8280.0, - 8651.599254402347, - 9446.414670877506 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1645559924308744, - "weakest_scaled_direction": [ - 0.9461732481841705, - 0.2759432206381766, - 0.034330039135898854, - -0.034559702916226495, - 0.10294116553337077, - 0.12506684288950312 - ] - }, - "forward_reverse": { - "translation_m": 0.00040681040655899406, - "rotation_deg": 0.015836974306118006 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6013727233123345e-15, - "rotation_deg": 1.0449449530345768e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279517.5427606, - "frame_counter_i": 190, - "frame_counter_j": 2006, - "rtk_translation_m": 1.1601020961002007, - "rtk_rotation_deg": 26.306295080591493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8991348333910094, - 0.4376461210422506, - 0.0047354112381163965, - -1.2994237130614943 - ], - [ - -0.43751132087840516, - 0.8990455786347796, - -0.017346228422605983, - -0.4866528814266956 - ], - [ - -0.01184886012051233, - 0.013524802177031465, - 0.9998383290512105, - -0.03740759870603205 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8207, - "backend_objective": 101.92156378870224, - "backend_elapsed_sec": 0.2527652999997372, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9102756892230577, - "inlier_rmse_m": 0.2796579862971408, - "target_points": 4045, - "source_points": 3990 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8805656678801456, - "inlier_rmse_m": 0.16808583343073918, - "target_points": 7608, - "source_points": 7142 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7961777260380287, - "inlier_rmse_m": 0.11143992792026089, - "target_points": 11238, - "source_points": 10308 - } - ], - "heldout_symmetric": { - "evaluated": 7897, - "inliers": 6473, - "inlier_ratio": 0.8196783588704571, - "inlier_rmse_m": 0.10111548255452249, - "median_m": 0.08313635348535349, - "p90_m": 0.45326843027951885, - "p95_m": 0.8192231529545402 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3668.5485083999256, - 5532.67188962687, - 7052.484678933464, - 8206.999999999996, - 9438.18372865436, - 11554.58924805422 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1496351272437915, - "weakest_scaled_direction": [ - 0.9427796721346611, - 0.02567160613382652, - 0.022269037588016505, - -0.01053835518424508, - 0.11841540089403894, - 0.3096421875555542 - ] - }, - "forward_reverse": { - "translation_m": 0.0024786662018318395, - "rotation_deg": 0.04305117802148083 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6322927535567607e-15, - "rotation_deg": 1.5565004702156658e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 190, - "frame_counter_j": 2883, - "rtk_translation_m": 1.1328421148283978, - "rtk_rotation_deg": 41.74134818989305, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7509148099579614, - 0.6603844337985864, - 0.004398611408123703, - -1.4657157076298504 - ], - [ - -0.6601117273045074, - 0.7507678840633041, - -0.02449676987215658, - -0.6527089949188399 - ], - [ - -0.01947962168161213, - 0.01549141231877653, - 0.9996902322637302, - -0.014970046264633597 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8540, - "backend_objective": 102.84130662063083, - "backend_elapsed_sec": 0.23046449999674223, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9042253521126761, - "inlier_rmse_m": 0.28902394369727824, - "target_points": 4045, - "source_points": 4260 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8676160337552743, - "inlier_rmse_m": 0.17102777302572325, - "target_points": 7608, - "source_points": 7584 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.782624633431085, - "inlier_rmse_m": 0.10973744833382358, - "target_points": 11238, - "source_points": 10912 - } - ], - "heldout_symmetric": { - "evaluated": 8061, - "inliers": 6586, - "inlier_ratio": 0.8170202208162759, - "inlier_rmse_m": 0.10132889132333661, - "median_m": 0.0817875224062471, - "p90_m": 0.47761583340701086, - "p95_m": 0.8644647381721635 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4102.544001659771, - 5421.08824979732, - 7180.413066405343, - 8540.000000000002, - 9818.178660555453, - 12158.647282068503 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9636847958606816, - "weakest_scaled_direction": [ - 0.8354962777877182, - 0.3089723902457714, - 0.029385707777420247, - -0.0556806116605193, - 0.10904164051517179, - 0.43660978249000904 - ] - }, - "forward_reverse": { - "translation_m": 0.001763337668740155, - "rotation_deg": 0.0152261810177797 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.93821660055105e-15, - "rotation_deg": 5.321698208332165e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279517.5427606, - "frame_counter_i": 1125, - "frame_counter_j": 2006, - "rtk_translation_m": 0.6927979865343085, - "rtk_rotation_deg": 13.107970594625625, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9753323672199924, - 0.220730194350412, - 0.00222592791355059, - -0.7523440660629745 - ], - [ - -0.22072961648645714, - 0.9753349072499967, - -0.0005050795799996437, - -0.24429662614698391 - ], - [ - -0.002282511508963788, - 1.2922477110098485e-06, - 0.9999973950663779, - -0.017125174982776763 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8029, - "backend_objective": 66.02047784180355, - "backend_elapsed_sec": 0.2346343999961391, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8734335839598998, - "inlier_rmse_m": 0.2849691740907654, - "target_points": 3930, - "source_points": 3990 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.821758611033324, - "inlier_rmse_m": 0.13971739366640104, - "target_points": 7415, - "source_points": 7142 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7789095847885138, - "inlier_rmse_m": 0.09067939266066577, - "target_points": 10961, - "source_points": 10308 - } - ], - "heldout_symmetric": { - "evaluated": 7815, - "inliers": 6133, - "inlier_ratio": 0.7847728726807421, - "inlier_rmse_m": 0.08513837010948266, - "median_m": 0.07176116932610245, - "p90_m": 0.7934975939266661, - "p95_m": 1.8733235788181273 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4454.579710464271, - 6514.396396128072, - 7936.413625386025, - 8029.000000000001, - 8811.11036668333, - 11789.078896334182 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6465075635845983, - "weakest_scaled_direction": [ - 0.803186636965093, - 0.5652514835415363, - 0.009453881440457978, - -0.10521957525475914, - 0.148744565067408, - 0.04578761870442415 - ] - }, - "forward_reverse": { - "translation_m": 0.003621881376895638, - "rotation_deg": 0.011153493139183525 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8427467049240674e-15, - "rotation_deg": 1.22623021401735e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 1125, - "frame_counter_j": 2883, - "rtk_translation_m": 0.7002295454253883, - "rtk_rotation_deg": 28.543023703927183, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8817207453388964, - 0.4717607355947109, - 0.0032149012673336782, - -0.8767105267694579 - ], - [ - -0.4717474983613738, - 0.8817240705464141, - -0.0041183988208593845, - -0.4475837976236766 - ], - [ - -0.004777554689039288, - 0.0021146560475875, - 0.9999863515073562, - 0.004469798445236706 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8310, - "backend_objective": 95.57678011327398, - "backend_elapsed_sec": 0.23759460000292165, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8654929577464788, - "inlier_rmse_m": 0.30523681013160797, - "target_points": 3930, - "source_points": 4260 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8276635021097046, - "inlier_rmse_m": 0.16575412985699545, - "target_points": 7415, - "source_points": 7584 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7615469208211144, - "inlier_rmse_m": 0.10724466225796409, - "target_points": 10961, - "source_points": 10912 - } - ], - "heldout_symmetric": { - "evaluated": 7979, - "inliers": 6292, - "inlier_ratio": 0.7885699962401304, - "inlier_rmse_m": 0.09713251502799032, - "median_m": 0.08331516886230406, - "p90_m": 0.7943970586055543, - "p95_m": 1.911669141071708 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4210.440191682877, - 6298.636120734743, - 8165.126542058915, - 8309.999999999998, - 8732.598790002006, - 11091.042496215396 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6341764735488145, - "weakest_scaled_direction": [ - 0.7782074202815449, - 0.5900604955646428, - 0.016932536793300243, - -0.09411488105790934, - 0.11979839961495721, - 0.15075093500089948 - ] - }, - "forward_reverse": { - "translation_m": 0.0014094469663425105, - "rotation_deg": 0.02902143941632062 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.280246046433299e-15, - "rotation_deg": 1.5260657578101825e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 1125, - "frame_counter_j": 3843, - "rtk_translation_m": 0.8045641659338967, - "rtk_rotation_deg": 57.731023816949346, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5322059747452068, - 0.8465748126254197, - 0.00823936124586185, - -1.0698432000519769 - ], - [ - -0.8463836723676353, - 0.5322628617473846, - -0.018191348327154598, - -0.44568743503695185 - ], - [ - -0.019785843297157574, - 0.002707883439146769, - 0.9998005740007858, - 0.016034215999013033 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7562, - "backend_objective": 90.55475380106924, - "backend_elapsed_sec": 0.2318271999974968, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8591583556312333, - "inlier_rmse_m": 0.31944530774041013, - "target_points": 3930, - "source_points": 4111 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8139820114472608, - "inlier_rmse_m": 0.1768639281630117, - "target_points": 7415, - "source_points": 7338 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.709247795910711, - "inlier_rmse_m": 0.10943022459368498, - "target_points": 10961, - "source_points": 10662 - } - ], - "heldout_symmetric": { - "evaluated": 8068, - "inliers": 5941, - "inlier_ratio": 0.7363658899355479, - "inlier_rmse_m": 0.09863727794945644, - "median_m": 0.09079531166458762, - "p90_m": 1.0943193500739292, - "p95_m": 1.8044928330277628 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3165.7867948401, - 4824.453586982898, - 7081.286182445055, - 7562.0, - 7797.8124455109055, - 8667.189844161938 - ], - "effective_rank": 6, - "scaled_condition_number": 2.7377680197189993, - "weakest_scaled_direction": [ - 0.8445095253947827, - 0.5059218990415713, - 0.02986592888208024, - -0.06245666780347373, - 0.09662292769496192, - 0.12929769669332902 - ] - }, - "forward_reverse": { - "translation_m": 0.011592408190980286, - "rotation_deg": 0.17084480097436408 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2235741413300504e-15, - "rotation_deg": 9.671263678862271e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 2006, - "frame_counter_j": 2883, - "rtk_translation_m": 0.13949776780243606, - "rtk_rotation_deg": 15.435053109301553, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9641174087850943, - 0.2654755172258279, - 0.0006097796284123591, - -0.07264947156529913 - ], - [ - -0.2654749494574412, - 0.9641173596970266, - -0.0008763226597170813, - -0.2272094605618682 - ], - [ - -0.0008205413366870627, - 0.0006829967159131456, - 0.9999994301135383, - 0.009647210341142905 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9525, - "backend_objective": 62.52233709329205, - "backend_elapsed_sec": 0.35214080000150716, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9633802816901409, - "inlier_rmse_m": 0.24811040993747058, - "target_points": 3990, - "source_points": 4260 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9227320675105485, - "inlier_rmse_m": 0.13502045327082282, - "target_points": 7142, - "source_points": 7584 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.872892228739003, - "inlier_rmse_m": 0.08101867001922584, - "target_points": 10308, - "source_points": 10912 - } - ], - "heldout_symmetric": { - "evaluated": 7612, - "inliers": 6990, - "inlier_ratio": 0.918286915396742, - "inlier_rmse_m": 0.07288259780013887, - "median_m": 0.043270270588385056, - "p90_m": 0.20479077644127688, - "p95_m": 0.4025860849813979 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6236.745564937643, - 6519.940433830745, - 8533.455070765704, - 9524.999999999995, - 12164.552905748438, - 16454.643661298323 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6383381348446657, - "weakest_scaled_direction": [ - 0.012782244327359757, - 0.7530559012345741, - 0.004004442775762601, - -0.18379043440210505, - -0.0002390877436315356, - 0.6316236279170773 - ] - }, - "forward_reverse": { - "translation_m": 0.002273707715582919, - "rotation_deg": 0.0026923349652342365 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.674299346818312e-15, - "rotation_deg": 9.508398397529715e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 2006, - "frame_counter_j": 3843, - "rtk_translation_m": 0.6701726006967371, - "rtk_rotation_deg": 44.62305322232371, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7053875306561629, - 0.7088083922122733, - 0.004369751051537653, - -0.2590149971858612 - ], - [ - -0.7087789967320047, - 0.7053992670216874, - -0.006648900423411234, - -0.2758845415559492 - ], - [ - -0.007795215607919538, - 0.0015928636849712992, - 0.9999683481985355, - 0.02506259326210177 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8556, - "backend_objective": 96.56748761383848, - "backend_elapsed_sec": 0.4856711999964318, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9523230357577231, - "inlier_rmse_m": 0.29670279817145423, - "target_points": 3990, - "source_points": 4111 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8950667756881984, - "inlier_rmse_m": 0.17561550774090562, - "target_points": 7142, - "source_points": 7338 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8024760832864378, - "inlier_rmse_m": 0.10623804699359538, - "target_points": 10308, - "source_points": 10662 - } - ], - "heldout_symmetric": { - "evaluated": 7701, - "inliers": 6446, - "inlier_ratio": 0.8370341514089079, - "inlier_rmse_m": 0.09441127521663696, - "median_m": 0.07519476782224029, - "p90_m": 0.4375204875590022, - "p95_m": 0.9619335509475425 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4348.718984491616, - 5957.440650219433, - 7541.329065985047, - 8555.999999999996, - 10766.112499610623, - 13454.818239991662 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0939727970407334, - "weakest_scaled_direction": [ - 0.9143470396587114, - 0.3543801438349223, - 0.004058714460435803, - -0.061953438119635086, - 0.15874165721575098, - 0.09659497569424896 - ] - }, - "forward_reverse": { - "translation_m": 0.0041401597740440875, - "rotation_deg": 0.03075174550917053 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.340849125339144e-15, - "rotation_deg": 1.2205469358568742e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 2006, - "frame_counter_j": 5003, - "rtk_translation_m": 0.8004226998626774, - "rtk_rotation_deg": 62.96656300910673, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.44864814681739656, - 0.8936691378587216, - 0.008385248724087831, - -0.43633091492314235 - ], - [ - -0.8934896789380539, - 0.44872616770594337, - -0.017917032318757607, - -0.42061051265639693 - ], - [ - -0.019774579350512054, - 0.0005463101559770343, - 0.9998043146319798, - 0.061983912110967036 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8123, - "backend_objective": 114.54931703978332, - "backend_elapsed_sec": 0.30735360000107903, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9417989417989417, - "inlier_rmse_m": 0.31520432672845644, - "target_points": 3990, - "source_points": 3969 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8752928207248174, - "inlier_rmse_m": 0.1814792338341028, - "target_points": 7142, - "source_points": 7257 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7627230046948357, - "inlier_rmse_m": 0.11875120507227022, - "target_points": 10308, - "source_points": 10650 - } - ], - "heldout_symmetric": { - "evaluated": 7622, - "inliers": 6277, - "inlier_ratio": 0.8235371293623721, - "inlier_rmse_m": 0.10626795357026747, - "median_m": 0.08340097833970556, - "p90_m": 0.41328524814315476, - "p95_m": 0.795307310893657 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4430.479285882621, - 4938.132379232599, - 6823.848575206934, - 8123.0, - 9884.084695523647, - 12417.688164542673 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8027866429960917, - "weakest_scaled_direction": [ - 0.37654854568911345, - 0.7944747909618561, - 0.01893049157238591, - -0.14074943383849767, - 0.05595473115260973, - 0.45135496085690613 - ] - }, - "forward_reverse": { - "translation_m": 0.009148796674106823, - "rotation_deg": 0.05256412309062332 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2834515500923294e-15, - "rotation_deg": 8.549660797673141e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 2883, - "frame_counter_j": 3843, - "rtk_translation_m": 0.5366157827594368, - "rtk_rotation_deg": 29.188000113022152, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8680968831625852, - 0.49638601189275633, - 0.002954427289545695, - -0.16312938210256805 - ], - [ - -0.4963803727666502, - 0.8681016538400713, - -0.0024584816805362283, - -0.09905606447305561 - ], - [ - -0.0037850991329176323, - 0.0006676805648891588, - 0.9999926135863291, - 0.004850072972114567 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9375, - "backend_objective": 68.30412568253172, - "backend_elapsed_sec": 0.28457479999633506, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.981269764047677, - "inlier_rmse_m": 0.24871846504079037, - "target_points": 4260, - "source_points": 4111 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9408558190242573, - "inlier_rmse_m": 0.13535263757404573, - "target_points": 7584, - "source_points": 7338 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8792909397861565, - "inlier_rmse_m": 0.08535674200751055, - "target_points": 10912, - "source_points": 10662 - } - ], - "heldout_symmetric": { - "evaluated": 7865, - "inliers": 6961, - "inlier_ratio": 0.8850603941513032, - "inlier_rmse_m": 0.07613142655207121, - "median_m": 0.0477767064513168, - "p90_m": 0.3007898932823837, - "p95_m": 0.6658825849745881 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5979.5955287178795, - 6412.400669531902, - 8488.463036160134, - 9375.000000000002, - 11865.673662697329, - 15796.650455035477 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6417590251999084, - "weakest_scaled_direction": [ - 0.7936862749537651, - 0.5483428884713639, - -0.02794737489825144, - -0.14838273767549365, - 0.21543799618192488, - 0.013044186836951136 - ] - }, - "forward_reverse": { - "translation_m": 0.0013904645484531576, - "rotation_deg": 0.0259404694028417 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.248045562514738e-16, - "rotation_deg": 6.010330560071098e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 2883, - "frame_counter_j": 5003, - "rtk_translation_m": 0.6760093701980526, - "rtk_rotation_deg": 47.53150989980517, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6689776613447939, - 0.7432785496925377, - 0.0024261468643807776, - -0.2851494780381888 - ], - [ - -0.7432691273647086, - 0.6689816400664577, - -0.0038170093655771143, - -0.2946162601761757 - ], - [ - -0.004460148893784541, - 0.0007502139359680303, - 0.9999897720731427, - 0.010661175020236252 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9054, - "backend_objective": 92.7816490645597, - "backend_elapsed_sec": 0.26467740000225604, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9800957420005039, - "inlier_rmse_m": 0.2760494931702256, - "target_points": 4260, - "source_points": 3969 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.931652197877911, - "inlier_rmse_m": 0.1626866712600423, - "target_points": 7584, - "source_points": 7257 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8501408450704225, - "inlier_rmse_m": 0.10123036401540922, - "target_points": 10912, - "source_points": 10650 - } - ], - "heldout_symmetric": { - "evaluated": 7786, - "inliers": 6805, - "inlier_ratio": 0.8740046236835346, - "inlier_rmse_m": 0.09072202522560696, - "median_m": 0.06676282809021862, - "p90_m": 0.3089743415638364, - "p95_m": 0.5536193240344602 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5395.8455499875645, - 6073.19999695844, - 8117.807242647549, - 9053.999999999998, - 11157.867608649776, - 14494.09121408684 - ], - "effective_rank": 6, - "scaled_condition_number": 2.686157540984516, - "weakest_scaled_direction": [ - 0.837664687905716, - 0.4925680752500768, - -0.012860784566948974, - -0.10984581027201963, - 0.18909649035212897, - 0.08778141832282683 - ] - }, - "forward_reverse": { - "translation_m": 0.006509933107990933, - "rotation_deg": 0.02545212192512678 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.957057868755777e-15, - "rotation_deg": 1.7136527022911156e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 2883, - "frame_counter_j": 1175, - "rtk_translation_m": 1.4361364806393455, - "rtk_rotation_deg": 80.09091141471853, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1634619921547601, - 0.986526892591935, - 0.006698306777962724, - 0.4198084175988475 - ], - [ - -0.9853702190701629, - 0.1635947093280042, - -0.047773449210932385, - -1.3027649994610806 - ], - [ - -0.0482255999487905, - 0.00120883116292296, - 0.9988357373646573, - -0.03464786023816554 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6370, - "backend_objective": 80.17633603760608, - "backend_elapsed_sec": 0.49402589999954216, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8705440900562852, - "inlier_rmse_m": 0.35201704657559363, - "target_points": 4260, - "source_points": 3731 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.752935793808144, - "inlier_rmse_m": 0.1773896773624573, - "target_points": 7584, - "source_points": 6557 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6589427950760318, - "inlier_rmse_m": 0.11218980331664288, - "target_points": 10912, - "source_points": 9667 - } - ], - "heldout_symmetric": { - "evaluated": 7762, - "inliers": 5275, - "inlier_ratio": 0.6795928884308168, - "inlier_rmse_m": 0.10271649349323747, - "median_m": 0.11575636045512414, - "p90_m": 1.3405674404020338, - "p95_m": 1.706308962691853 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3040.0536294021013, - 4794.234467447171, - 5819.184598807475, - 6370.000000000002, - 6991.894648874017, - 9144.988673798447 - ], - "effective_rank": 6, - "scaled_condition_number": 3.008166890660092, - "weakest_scaled_direction": [ - 0.30622005750836484, - -0.8649846712721722, - -0.03521657708202808, - 0.13032280799450552, - 0.06115469293374783, - -0.3688721415219341 - ] - }, - "forward_reverse": { - "translation_m": 0.00828154435242913, - "rotation_deg": 0.026486510290724834 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.687154578819224e-16, - "rotation_deg": 9.212597328204569e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 3843, - "frame_counter_j": 5003, - "rtk_translation_m": 0.17861948949299924, - "rtk_rotation_deg": 18.343509786783002, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.949706558221048, - 0.31314061954854255, - 0.0006369149754132204, - -0.012048304052610256 - ], - [ - -0.31314007001873106, - 0.949706587126091, - -0.0008336174048488439, - -0.22820420895727614 - ], - [ - -0.0008659218182100035, - 0.0005922483164352834, - 0.9999994497105168, - 0.012326464623992516 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9148, - "backend_objective": 69.89503379433593, - "backend_elapsed_sec": 0.24209659999905853, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9687578735197783, - "inlier_rmse_m": 0.24303407470384839, - "target_points": 4111, - "source_points": 3969 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9330301777594047, - "inlier_rmse_m": 0.14446570672800857, - "target_points": 7338, - "source_points": 7257 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8589671361502348, - "inlier_rmse_m": 0.0874097909619125, - "target_points": 10662, - "source_points": 10650 - } - ], - "heldout_symmetric": { - "evaluated": 7875, - "inliers": 6839, - "inlier_ratio": 0.8684444444444445, - "inlier_rmse_m": 0.0784387700526441, - "median_m": 0.048576299554205206, - "p90_m": 0.33383419506997325, - "p95_m": 0.6930052937899469 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5782.773173082075, - 6095.44391866886, - 8077.2384249200395, - 9148.000000000002, - 11663.051470606772, - 15533.658952402866 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6861954442048104, - "weakest_scaled_direction": [ - 0.7624156516745856, - -0.1325436216767047, - -0.015183310152936112, - 0.020301518967376128, - 0.18607007661184558, - -0.6048882578166963 - ] - }, - "forward_reverse": { - "translation_m": 0.0025072579888539386, - "rotation_deg": 0.021042298559759365 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0508593164539734e-15, - "rotation_deg": 1.242174586889897e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 3843, - "frame_counter_j": 1175, - "rtk_translation_m": 1.5807073315069207, - "rtk_rotation_deg": 50.90291130169636, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6310708689423248, - 0.7753848392744062, - 0.02297627898034666, - 1.1071578347309774 - ], - [ - -0.7745988471714546, - 0.6314736381569497, - -0.03518053827728588, - -0.7606464119615669 - ], - [ - -0.041787370496748986, - 0.004404013650039271, - 0.999116820162056, - -0.014330949660854431 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6330, - "backend_objective": 84.60861420454904, - "backend_elapsed_sec": 0.3179699999964214, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8721522380058966, - "inlier_rmse_m": 0.3517348855265171, - "target_points": 4111, - "source_points": 3731 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7689492145798383, - "inlier_rmse_m": 0.191555406582433, - "target_points": 7338, - "source_points": 6557 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6548050067239061, - "inlier_rmse_m": 0.11561267129407496, - "target_points": 10662, - "source_points": 9667 - } - ], - "heldout_symmetric": { - "evaluated": 7851, - "inliers": 5324, - "inlier_ratio": 0.6781301745000636, - "inlier_rmse_m": 0.10313081772493418, - "median_m": 0.11355750805894088, - "p90_m": 1.4200387372496468, - "p95_m": 1.7765788920212762 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2918.632955798317, - 3642.50433618894, - 5267.529292714469, - 6330.0, - 7040.843580221419, - 8305.033481044022 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8455217243212387, - "weakest_scaled_direction": [ - -0.4673094978306648, - 0.8017043801229458, - 0.050636239846211954, - -0.09929010129825448, - -0.07976497253778664, - 0.34656444751791776 - ] - }, - "forward_reverse": { - "translation_m": 0.003271195715147848, - "rotation_deg": 0.14716032493381534 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0259243220665082e-15, - "rotation_deg": 1.025554006517916e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 3843, - "frame_counter_j": 2514, - "rtk_translation_m": 1.7804201387535592, - "rtk_rotation_deg": 75.18775779751417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.25106887840242054, - 0.9679610447993253, - -0.003979202023916303, - -0.16822332264444564 - ], - [ - -0.9675096394352387, - 0.2508208893743169, - -0.03184303775350098, - 0.33974884457438315 - ], - [ - -0.029824753102824474, - 0.011844712089096661, - 0.9994849608162588, - -0.006084050885040562 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8073, - "backend_objective": 98.60875078457671, - "backend_elapsed_sec": 0.46654860000126064, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9622966978807295, - "inlier_rmse_m": 0.3001429019128497, - "target_points": 4111, - "source_points": 4058 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9024561403508772, - "inlier_rmse_m": 0.17950468078269297, - "target_points": 7338, - "source_points": 7125 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7830261881668283, - "inlier_rmse_m": 0.11051984120939964, - "target_points": 10662, - "source_points": 10310 - } - ], - "heldout_symmetric": { - "evaluated": 7750, - "inliers": 6102, - "inlier_ratio": 0.7873548387096774, - "inlier_rmse_m": 0.09891997778736471, - "median_m": 0.08756369878847638, - "p90_m": 0.5673251872335188, - "p95_m": 1.38675199859047 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3593.1765060647745, - 4754.325161349418, - 6544.36581683475, - 8073.0, - 9706.304534159462, - 11427.35705381323 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1802938248442474, - "weakest_scaled_direction": [ - 0.42887121488253205, - 0.8824676778541745, - 0.035240972547791335, - -0.11922374385257438, - 0.06327853918352325, - -0.1336408538670091 - ] - }, - "forward_reverse": { - "translation_m": 0.004633577062239209, - "rotation_deg": 0.04472721629193465 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6737555667138715e-15, - "rotation_deg": 7.614791096714616e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 5003, - "frame_counter_j": 1175, - "rtk_translation_m": 1.5316987521992935, - "rtk_rotation_deg": 32.55940151491337, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8417211829883782, - 0.5394384072505995, - 0.022619789821787806, - 1.2363423732781946 - ], - [ - -0.5391654063944628, - 0.8420216782853102, - -0.01732506407156325, - -0.16287166582709678 - ], - [ - -0.02839215835648143, - 0.0023870652538441244, - 0.9995940112182219, - -0.0024878194533908896 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6463, - "backend_objective": 80.2215294204414, - "backend_elapsed_sec": 0.19403109999984736, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8809970517287591, - "inlier_rmse_m": 0.34488451358521954, - "target_points": 3969, - "source_points": 3731 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7732194601189568, - "inlier_rmse_m": 0.18295855586051168, - "target_points": 7257, - "source_points": 6557 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6685631529947244, - "inlier_rmse_m": 0.11141108168744586, - "target_points": 10650, - "source_points": 9667 - } - ], - "heldout_symmetric": { - "evaluated": 7772, - "inliers": 5372, - "inlier_ratio": 0.6911991765311374, - "inlier_rmse_m": 0.10152400788085783, - "median_m": 0.11024327995267678, - "p90_m": 1.2342728417674012, - "p95_m": 1.63291336818886 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2921.48226284872, - 4818.849260508063, - 5708.222427321079, - 6463.0, - 7280.005629157428, - 9463.707527181998 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2393513551418907, - "weakest_scaled_direction": [ - 0.8510755811736224, - -0.30231412056328827, - -0.018335673274537063, - 0.03810581530709391, - 0.13191858180370522, - -0.40630747635045633 - ] - }, - "forward_reverse": { - "translation_m": 0.005288907067525738, - "rotation_deg": 0.05494235971756111 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.290993805754059e-15, - "rotation_deg": 6.276046403252319e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 5003, - "frame_counter_j": 2514, - "rtk_translation_m": 1.6091514152462776, - "rtk_rotation_deg": 56.844248010731185, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5413139449153095, - 0.8408098437260507, - 0.004244965677160483, - -0.3288763589658891 - ], - [ - -0.8404491581411917, - 0.5412179843018403, - -0.0269871459775858, - 0.48799435500520466 - ], - [ - -0.02498850975924932, - 0.01104084062142452, - 0.9996267674579268, - -0.008601448865444642 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7838, - "backend_objective": 80.25504133601885, - "backend_elapsed_sec": 0.21071910000318894, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9445539674716609, - "inlier_rmse_m": 0.2964934889695369, - "target_points": 3969, - "source_points": 4058 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8920701754385965, - "inlier_rmse_m": 0.17234479852647022, - "target_points": 7257, - "source_points": 7125 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7602327837051407, - "inlier_rmse_m": 0.10118905307574161, - "target_points": 10650, - "source_points": 10310 - } - ], - "heldout_symmetric": { - "evaluated": 7671, - "inliers": 5943, - "inlier_ratio": 0.7747360187719984, - "inlier_rmse_m": 0.09121609616459708, - "median_m": 0.06998852034462234, - "p90_m": 0.5998562021948411, - "p95_m": 1.2370805355678165 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3518.022046808358, - 4519.620179137036, - 6306.3027382639575, - 7838.000000000001, - 9311.542946856624, - 10988.447934058491 - ], - "effective_rank": 6, - "scaled_condition_number": 3.123473300580222, - "weakest_scaled_direction": [ - 0.06510738287407536, - 0.9704291898810823, - 0.012309010692294823, - -0.11972948075968146, - 0.01055149513931549, - -0.19857044534661794 - ] - }, - "forward_reverse": { - "translation_m": 0.00421464356720393, - "rotation_deg": 0.015634168997181876 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5899723589751917e-15, - "rotation_deg": 2.2330749729216292e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 5003, - "frame_counter_j": 3477, - "rtk_translation_m": 1.1872485760158462, - "rtk_rotation_deg": 85.67585439000777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.077541240991801, - 0.9969866621088175, - 0.00222520169157605, - -0.23030793726593274 - ], - [ - -0.9960998941902651, - 0.07756613240698304, - -0.04205348853026462, - -0.6182989134565668 - ], - [ - -0.04209936744886125, - 0.0010443565191403078, - 0.9991128828014729, - -0.01829668246214328 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7574, - "backend_objective": 107.70536259104422, - "backend_elapsed_sec": 0.6492373000000953, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9491127348643006, - "inlier_rmse_m": 0.3368936559349473, - "target_points": 3969, - "source_points": 3832 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8740815444460452, - "inlier_rmse_m": 0.1878489468812608, - "target_points": 7257, - "source_points": 6941 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7401544024235317, - "inlier_rmse_m": 0.11924934799168091, - "target_points": 10650, - "source_points": 10233 - } - ], - "heldout_symmetric": { - "evaluated": 7694, - "inliers": 6024, - "inlier_ratio": 0.7829477514946712, - "inlier_rmse_m": 0.10577559680144696, - "median_m": 0.09491903023691711, - "p90_m": 0.6212436337359116, - "p95_m": 1.1308432324840463 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3230.2216195359238, - 4195.560838858811, - 6054.034625939664, - 7574.000000000002, - 8749.638099656688, - 10043.466485785315 - ], - "effective_rank": 6, - "scaled_condition_number": 3.109219016133088, - "weakest_scaled_direction": [ - -0.14711880792976245, - -0.9748814038816518, - -0.045629640745335154, - 0.11795211201066712, - -0.0127144604912043, - -0.10865487734638983 - ] - }, - "forward_reverse": { - "translation_m": 0.0033105282814613057, - "rotation_deg": 0.030813019102438145 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2779673821747284e-15, - "rotation_deg": 4.478265346061272e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 1175, - "frame_counter_j": 2514, - "rtk_translation_m": 1.5692385974903325, - "rtk_rotation_deg": 24.284846495817817, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.909369465730767, - 0.4157953631172824, - -0.012703968148111136, - -1.6688450562613089 - ], - [ - -0.4159714654227905, - 0.9091896575161049, - -0.01849071712411497, - -0.2991620300634269 - ], - [ - 0.003861962008756328, - 0.022099381799389407, - 0.9997483196152558, - -0.03905801206833269 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7197, - "backend_objective": 95.43863470511116, - "backend_elapsed_sec": 0.26640210000186926, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9011828486939379, - "inlier_rmse_m": 0.35761433205769144, - "target_points": 3731, - "source_points": 4058 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8074385964912281, - "inlier_rmse_m": 0.18947528638945144, - "target_points": 6557, - "source_points": 7125 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6980601357904946, - "inlier_rmse_m": 0.11515594340997576, - "target_points": 9667, - "source_points": 10310 - } - ], - "heldout_symmetric": { - "evaluated": 7647, - "inliers": 5619, - "inlier_ratio": 0.7347979599843075, - "inlier_rmse_m": 0.10196810239533251, - "median_m": 0.09824742059772812, - "p90_m": 1.3455643432128441, - "p95_m": 2.318787521923948 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3251.574266542989, - 4238.931371546178, - 5384.124535984673, - 7197.0000000000055, - 9178.80794470799, - 11246.695435548118 - ], - "effective_rank": 6, - "scaled_condition_number": 3.458846242963224, - "weakest_scaled_direction": [ - -0.6065859745986313, - -0.5688415559005977, - -0.02747904575983982, - 0.06815227277987493, - -0.09883630524207224, - 0.5415757511428834 - ] - }, - "forward_reverse": { - "translation_m": 0.004020707752206965, - "rotation_deg": 0.039850323489805044 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.213913156460973e-16, - "rotation_deg": 1.0199075357150473e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 1175, - "frame_counter_j": 3477, - "rtk_translation_m": 0.5035712140385419, - "rtk_rotation_deg": 53.11645287509441, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.603320141105853, - 0.7974345064513491, - -0.010149643181272861, - -0.9839803639525855 - ], - [ - -0.7973199926722587, - 0.6028660853049281, - -0.028867152166795196, - -1.1754783611865822 - ], - [ - -0.016900787588848498, - 0.02550864774551353, - 0.9995317264944983, - -0.04441253768043292 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6727, - "backend_objective": 93.88305085893276, - "backend_elapsed_sec": 0.34034799999790266, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9055323590814196, - "inlier_rmse_m": 0.376344670124916, - "target_points": 3731, - "source_points": 3832 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7775536666186429, - "inlier_rmse_m": 0.198149386571553, - "target_points": 6557, - "source_points": 6941 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6573829766441903, - "inlier_rmse_m": 0.11813616902218058, - "target_points": 9667, - "source_points": 10233 - } - ], - "heldout_symmetric": { - "evaluated": 7670, - "inliers": 5488, - "inlier_ratio": 0.7155149934810952, - "inlier_rmse_m": 0.10460245111398395, - "median_m": 0.10882433268402252, - "p90_m": 1.2706661262326489, - "p95_m": 1.9658154477318748 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3308.836306007914, - 3998.0319785308093, - 5377.28180493756, - 6727.000000000002, - 8094.539745555698, - 9986.28998196076 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0180670962260874, - "weakest_scaled_direction": [ - 0.585545880393189, - 0.61277352528694, - 0.028502821910625264, - -0.07428393987644276, - 0.0949863123090485, - -0.5160346059669577 - ] - }, - "forward_reverse": { - "translation_m": 0.0072368624874882504, - "rotation_deg": 0.0055907688631446776 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.646888702276032e-15, - "rotation_deg": 8.08430617473953e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 1175, - "frame_counter_j": 4392, - "rtk_translation_m": 0.8508108569116883, - "rtk_rotation_deg": 66.44324365209327, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4032044291376529, - 0.9150040283449594, - -0.013921797164056374, - -1.6132163617553361 - ], - [ - -0.9145782039071841, - 0.4024049705142674, - -0.0402112999456726, - -1.0616599707023038 - ], - [ - -0.031191301057970158, - 0.02894594648494065, - 0.9990942072299299, - -0.055968465976034255 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6272, - "backend_objective": 91.82643911195646, - "backend_elapsed_sec": 0.30341279999993276, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.899055330634278, - "inlier_rmse_m": 0.3863021879172859, - "target_points": 3731, - "source_points": 3705 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7695254936634247, - "inlier_rmse_m": 0.2052788848051741, - "target_points": 6557, - "source_points": 6786 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6343683624962071, - "inlier_rmse_m": 0.12099873971026578, - "target_points": 9667, - "source_points": 9887 - } - ], - "heldout_symmetric": { - "evaluated": 7642, - "inliers": 5216, - "inlier_ratio": 0.6825438366919655, - "inlier_rmse_m": 0.10495957402394829, - "median_m": 0.11843508016182444, - "p90_m": 1.2878255492029502, - "p95_m": 1.8594187846882724 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2729.799324406446, - 3020.935973325237, - 4554.176694565421, - 6272.0, - 7428.556993774606, - 8573.252310711958 - ], - "effective_rank": 6, - "scaled_condition_number": 3.140616320789838, - "weakest_scaled_direction": [ - -0.3170959766115519, - -0.8108442883951542, - -0.05633760131497364, - 0.08511439228796283, - -0.0664003321101151, - 0.47660706288609955 - ] - }, - "forward_reverse": { - "translation_m": 0.00430894236478819, - "rotation_deg": 0.13911475434755866 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.926969055564841e-16, - "rotation_deg": 1.7528594472389536e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 2514, - "frame_counter_j": 3477, - "rtk_translation_m": 1.1230406357307108, - "rtk_rotation_deg": 28.831606379276582, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8800877605578602, - 0.4746551470122815, - 0.012166557894531606, - 0.9810812979438829 - ], - [ - -0.47453870165309886, - 0.8801619022483836, - -0.011315761746213324, - -0.5164994243484108 - ], - [ - -0.016079625295470867, - 0.004185360827372889, - 0.9998619546742948, - 0.011646083370361354 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7570, - "backend_objective": 90.0531605764691, - "backend_elapsed_sec": 0.3074345999993966, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9000521920668059, - "inlier_rmse_m": 0.3093044312517381, - "target_points": 4058, - "source_points": 3832 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8335974643423137, - "inlier_rmse_m": 0.17926121221652866, - "target_points": 7125, - "source_points": 6941 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.739763510212059, - "inlier_rmse_m": 0.10906905244076419, - "target_points": 10310, - "source_points": 10233 - } - ], - "heldout_symmetric": { - "evaluated": 7569, - "inliers": 6152, - "inlier_ratio": 0.8127890077949531, - "inlier_rmse_m": 0.09942756972076687, - "median_m": 0.08292479266625323, - "p90_m": 0.5438800420107537, - "p95_m": 1.0693714439099489 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3611.958847568364, - 4464.037782097441, - 6291.300772107081, - 7570.000000000002, - 8915.869491924625, - 10632.365965781804 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9436564519387325, - "weakest_scaled_direction": [ - 0.8318537166016228, - -0.5307085292795825, - -0.04336312128148241, - 0.0642754166233904, - 0.10833391080573856, - -0.09284355349791724 - ] - }, - "forward_reverse": { - "translation_m": 0.008316114154115147, - "rotation_deg": 0.01814737917470093 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.6326453036832e-16, - "rotation_deg": 1.7817544835002188e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 2514, - "frame_counter_j": 4392, - "rtk_translation_m": 0.7186795671679719, - "rtk_rotation_deg": 42.158397156275456, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7469675475884987, - 0.6647892382172473, - 0.009734043361034577, - 0.36695337930346716 - ], - [ - -0.6645378964349082, - 0.7469811134968042, - -0.02021386358272229, - -0.6729184052142203 - ], - [ - -0.020709105521237097, - 0.008630459408726462, - 0.999748292381089, - -0.0033328149186441463 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7711, - "backend_objective": 82.61339869017243, - "backend_elapsed_sec": 0.45465060000424273, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9284750337381916, - "inlier_rmse_m": 0.2979007381533848, - "target_points": 4058, - "source_points": 3705 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8676687297376953, - "inlier_rmse_m": 0.1693049931162617, - "target_points": 7125, - "source_points": 6786 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7799130170931526, - "inlier_rmse_m": 0.10350704092209248, - "target_points": 10310, - "source_points": 9887 - } - ], - "heldout_symmetric": { - "evaluated": 7541, - "inliers": 6179, - "inlier_ratio": 0.8193873491579367, - "inlier_rmse_m": 0.09507291602212191, - "median_m": 0.07159689625711312, - "p90_m": 0.4468090141409177, - "p95_m": 0.8321786618915491 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3085.2667211895887, - 4739.387554479704, - 6261.145737318091, - 7711.0, - 9334.792140158746, - 10802.242301701917 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5012345051117295, - "weakest_scaled_direction": [ - 0.6672083263411354, - -0.7344958205270795, - -0.03643397944693248, - 0.08756955686690325, - 0.07966863166499305, - -0.002446603714453496 - ] - }, - "forward_reverse": { - "translation_m": 0.006751593996528964, - "rotation_deg": 0.029293578235221863 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.4559610222309504e-15, - "rotation_deg": 4.231900556856135e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 2514, - "frame_counter_j": 5391, - "rtk_translation_m": 0.39293571356254015, - "rtk_rotation_deg": 58.25702665650087, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5309622849668493, - 0.8473750748694553, - -0.0058766004431752925, - -0.4309471628172717 - ], - [ - -0.8468954583434329, - 0.5303980442912556, - -0.03802627051498011, - -0.7720668274376397 - ], - [ - -0.029105576442496117, - 0.025167381707225503, - 0.9992594599592006, - -0.009317979257839589 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7746, - "backend_objective": 105.72490584221745, - "backend_elapsed_sec": 0.2596763000037754, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9368503118503119, - "inlier_rmse_m": 0.3073016998277781, - "target_points": 4058, - "source_points": 3848 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8696083995459705, - "inlier_rmse_m": 0.17858312492414546, - "target_points": 7125, - "source_points": 7048 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7579998042861337, - "inlier_rmse_m": 0.11682879766181706, - "target_points": 10310, - "source_points": 10219 - } - ], - "heldout_symmetric": { - "evaluated": 7661, - "inliers": 6083, - "inlier_ratio": 0.7940216681895313, - "inlier_rmse_m": 0.10356080767641777, - "median_m": 0.08579604241842641, - "p90_m": 0.5448347819600656, - "p95_m": 1.070402778792556 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3763.511904408025, - 4076.4403707480983, - 6199.560707021418, - 7745.999999999998, - 9025.97885237103, - 10604.978136061101 - ], - "effective_rank": 6, - "scaled_condition_number": 2.817840996766873, - "weakest_scaled_direction": [ - 0.7759717636092632, - -0.6150818284939161, - -0.031877792033043084, - 0.08008446058072365, - 0.10303699628457473, - -0.03867595225661579 - ] - }, - "forward_reverse": { - "translation_m": 0.006883567504360684, - "rotation_deg": 0.016492683422577963 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6696712345245835e-15, - "rotation_deg": 9.371333185040777e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 3477, - "frame_counter_j": 4392, - "rtk_translation_m": 0.4407680716864947, - "rtk_rotation_deg": 13.326790776998866, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9730604985860675, - 0.23053383564009525, - 0.0027233649222573866, - -0.4682011153242637 - ], - [ - -0.23052110744615814, - 0.9730577551858872, - -0.004315564203887813, - -0.43425053078551284 - ], - [ - -0.003644874926677113, - 0.003571511958056465, - 0.9999869795097845, - -0.021741367073510348 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8444, - "backend_objective": 93.31820898328445, - "backend_elapsed_sec": 0.276112399995327, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9624831309041836, - "inlier_rmse_m": 0.2740022022297965, - "target_points": 3832, - "source_points": 3705 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9230769230769231, - "inlier_rmse_m": 0.1621872689645733, - "target_points": 6941, - "source_points": 6786 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8540507737432993, - "inlier_rmse_m": 0.10512574466463366, - "target_points": 10233, - "source_points": 9887 - } - ], - "heldout_symmetric": { - "evaluated": 7564, - "inliers": 6491, - "inlier_ratio": 0.8581438392384981, - "inlier_rmse_m": 0.09484304022144129, - "median_m": 0.06673900660251131, - "p90_m": 0.3359341949379208, - "p95_m": 0.516663855677286 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4248.4365285936965, - 4704.923279532026, - 6453.367195170267, - 8444.000000000002, - 11270.266379787867, - 13679.222467684725 - ], - "effective_rank": 6, - "scaled_condition_number": 3.219825075793889, - "weakest_scaled_direction": [ - 0.9078451461773153, - 0.19827489855400202, - -0.0036392632358747934, - -0.03270695064273237, - 0.143536506447075, - -0.3388488418534317 - ] - }, - "forward_reverse": { - "translation_m": 0.007253035671159373, - "rotation_deg": 0.024252719250072975 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.014061021199955e-15, - "rotation_deg": 2.2438997897867956e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 3477, - "frame_counter_j": 5391, - "rtk_translation_m": 0.968166048306331, - "rtk_rotation_deg": 29.425420277224287, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8696311519038741, - 0.49370143247118076, - -0.0007451269987522027, - -1.125141910763932 - ], - [ - -0.4935194857213101, - 0.869267646750724, - -0.028500447818112076, - -0.9046799302642914 - ], - [ - -0.01342299712113632, - 0.025152611959062307, - 0.9995935020096537, - -0.052807082965451696 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7870, - "backend_objective": 106.03258565015472, - "backend_elapsed_sec": 0.25978860000032, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9168399168399168, - "inlier_rmse_m": 0.33593604946932026, - "target_points": 3832, - "source_points": 3848 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8453461975028377, - "inlier_rmse_m": 0.17274609668040683, - "target_points": 6941, - "source_points": 7048 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7701340639984343, - "inlier_rmse_m": 0.11607329413983222, - "target_points": 10233, - "source_points": 10219 - } - ], - "heldout_symmetric": { - "evaluated": 7684, - "inliers": 6159, - "inlier_ratio": 0.8015356585111921, - "inlier_rmse_m": 0.10152298131640612, - "median_m": 0.0866828058521082, - "p90_m": 0.6017817089753135, - "p95_m": 1.1789766676796014 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3190.852532643731, - 3890.1063795472433, - 5376.4042209433965, - 7869.999999999996, - 10333.718997815293, - 11948.653078546733 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7446585062478155, - "weakest_scaled_direction": [ - 0.905584080437285, - 0.24698602216590823, - -0.015610160932019144, - -0.032935731970230676, - 0.10003001172048051, - -0.32799532817355853 - ] - }, - "forward_reverse": { - "translation_m": 0.0017523919908150464, - "rotation_deg": 0.05042176209078739 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.759257508228718e-15, - "rotation_deg": 1.1456473981826159e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 3477, - "frame_counter_j": 6461, - "rtk_translation_m": 3.0540124804140354, - "rtk_rotation_deg": 66.34511043540417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4035241098199923, - 0.9146365323826074, - -0.024663868818617995, - -3.727865599603048 - ], - [ - -0.9148396176718507, - 0.40286710864968495, - -0.027686941078161494, - -0.444624628370727 - ], - [ - -0.015387226260939451, - 0.03373583257253685, - 0.9993123269872298, - -0.09383466019917015 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7200, - "backend_objective": 99.43755427161317, - "backend_elapsed_sec": 0.29565310000180034, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8347069597069597, - "inlier_rmse_m": 0.41003669043593227, - "target_points": 3832, - "source_points": 4368 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7227811027632752, - "inlier_rmse_m": 0.1902878747401114, - "target_points": 6941, - "source_points": 7853 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6342494714587738, - "inlier_rmse_m": 0.11751923853826206, - "target_points": 10233, - "source_points": 11352 - } - ], - "heldout_symmetric": { - "evaluated": 7947, - "inliers": 5473, - "inlier_ratio": 0.688687555052221, - "inlier_rmse_m": 0.10536230082368817, - "median_m": 0.11701173340841095, - "p90_m": 1.0591026494670361, - "p95_m": 1.8243284491175211 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2648.6631767787794, - 3076.4164931936048, - 4174.083064036209, - 7200.000000000002, - 10965.66864702295, - 12439.77879284685 - ], - "effective_rank": 6, - "scaled_condition_number": 4.696625415382456, - "weakest_scaled_direction": [ - 0.8802022118193044, - 0.24903962274698477, - 0.012416251565839795, - -0.024663163959264073, - 0.10654968682177843, - -0.38872620427390425 - ] - }, - "forward_reverse": { - "translation_m": 0.0036281146181207165, - "rotation_deg": 0.013078005975049522 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.030446228992703e-15, - "rotation_deg": 1.4293329642724027e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 4392, - "frame_counter_j": 5391, - "rtk_translation_m": 0.5276649044820116, - "rtk_rotation_deg": 16.098629500225417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9600023180007806, - 0.27999201931788914, - -0.0001362035909035107, - -0.5291257928278472 - ], - [ - -0.2799225385967586, - 0.959753024790732, - -0.022748709646630515, - -0.6074080080749522 - ], - [ - -0.006238735342479411, - 0.02187694044722371, - 0.9997412053416601, - -0.025019763697622 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8405, - "backend_objective": 100.40100529702568, - "backend_elapsed_sec": 0.19360790000064299, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9501039501039501, - "inlier_rmse_m": 0.29783568399650034, - "target_points": 3705, - "source_points": 3848 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8944381384790011, - "inlier_rmse_m": 0.1622495982632625, - "target_points": 6786, - "source_points": 7048 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8224875232410216, - "inlier_rmse_m": 0.10929496913967085, - "target_points": 9887, - "source_points": 10219 - } - ], - "heldout_symmetric": { - "evaluated": 7656, - "inliers": 6554, - "inlier_ratio": 0.8560606060606061, - "inlier_rmse_m": 0.09594368034796862, - "median_m": 0.06940604350531016, - "p90_m": 0.37363815678921475, - "p95_m": 0.89067960984158 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4033.592165499548, - 5373.246291222717, - 6661.3629752034385, - 8404.999999999998, - 10469.443329777254, - 13221.529805182006 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2778548903058375, - "weakest_scaled_direction": [ - 0.0024819709189638686, - 0.8247888365979241, - 0.0074303415314328145, - -0.12243647949871828, - 0.005340785568130159, - -0.5519445528003706 - ] - }, - "forward_reverse": { - "translation_m": 0.010491037599418197, - "rotation_deg": 0.0599937188173442 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0202093692731435e-15, - "rotation_deg": 1.89095036815622e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 4392, - "frame_counter_j": 6461, - "rtk_translation_m": 2.680593454060616, - "rtk_rotation_deg": 53.0183196584053, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6039343770048785, - 0.7966332721858269, - -0.025272473528158465, - -3.163848905956909 - ], - [ - -0.7970288549385006, - 0.60351234654568, - -0.02275636092061062, - -0.7748139015776284 - ], - [ - -0.00287622446123521, - 0.03388623929309886, - 0.9994215577619987, - -0.08887968329879485 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7169, - "backend_objective": 99.77412369235653, - "backend_elapsed_sec": 0.2565921999994316, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8358516483516484, - "inlier_rmse_m": 0.41868349333356286, - "target_points": 3705, - "source_points": 4368 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7263466191264485, - "inlier_rmse_m": 0.19100416977562598, - "target_points": 6786, - "source_points": 7853 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6315186751233263, - "inlier_rmse_m": 0.1179721979468144, - "target_points": 9887, - "source_points": 11352 - } - ], - "heldout_symmetric": { - "evaluated": 7919, - "inliers": 5517, - "inlier_ratio": 0.6966788735951509, - "inlier_rmse_m": 0.10384409271666459, - "median_m": 0.11404176107763334, - "p90_m": 1.003691866164878, - "p95_m": 1.529023960020839 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2853.037055947242, - 3567.2207708899523, - 4525.03414256231, - 7169.000000000004, - 10533.325461331211, - 12387.617436587334 - ], - "effective_rank": 6, - "scaled_condition_number": 4.3419055531595605, - "weakest_scaled_direction": [ - 0.4963978610572622, - 0.6176137994296373, - 0.008006960688888705, - -0.07055181798166565, - 0.06451526015309628, - -0.6024437476306389 - ] - }, - "forward_reverse": { - "translation_m": 0.009543265092514783, - "rotation_deg": 0.09977883713501384 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.039807479139485e-15, - "rotation_deg": 1.8765465625211147e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 4392, - "frame_counter_j": 7268, - "rtk_translation_m": 3.2944321799753977, - "rtk_rotation_deg": 73.22024906015783, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.28811800111906577, - 0.9573605141815017, - -0.02118639462684303, - -4.167434653726929 - ], - [ - -0.9574541432973267, - 0.2876257838624052, - -0.023515355415528193, - -0.7449050685604787 - ], - [ - -0.01641891939000686, - 0.027060198514929468, - 0.999498956849079, - -0.13379229435368376 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6845, - "backend_objective": 98.07744733103019, - "backend_elapsed_sec": 0.24914900000294438, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7950475348220207, - "inlier_rmse_m": 0.4219209753936847, - "target_points": 3705, - "source_points": 4523 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6810534016093636, - "inlier_rmse_m": 0.19706779683947095, - "target_points": 6786, - "source_points": 8202 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5782226727487751, - "inlier_rmse_m": 0.1197010198822539, - "target_points": 9887, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 8007, - "inliers": 5268, - "inlier_ratio": 0.6579243162233046, - "inlier_rmse_m": 0.10621203405076814, - "median_m": 0.12584707374511558, - "p90_m": 1.2063764231347756, - "p95_m": 1.8466320754067809 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2798.526889071021, - 3251.0108433306837, - 4265.537694894901, - 6845.000000000002, - 10286.55878887731, - 12016.55330643548 - ], - "effective_rank": 6, - "scaled_condition_number": 4.293885241325807, - "weakest_scaled_direction": [ - 0.5133187614364098, - 0.60385736687642, - 0.010215450507325263, - -0.06598681364889988, - 0.06628567121819078, - -0.6025012235780262 - ] - }, - "forward_reverse": { - "translation_m": 0.0028782078295197843, - "rotation_deg": 0.0743495992598884 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.29285671876726e-16, - "rotation_deg": 1.339182143333734e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 5391, - "frame_counter_j": 6461, - "rtk_translation_m": 2.249454986440387, - "rtk_rotation_deg": 36.91969015817989, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.802712856951025, - 0.5958816843809461, - -0.02402264566730904, - -2.482954005313319 - ], - [ - -0.59616742851518, - 0.8028333385595076, - -0.0065595483833477165, - -0.8991253862331925 - ], - [ - 0.015377466082670268, - 0.019586952716716493, - 0.9996898943273107, - -0.06209388985348901 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7450, - "backend_objective": 114.24124929326598, - "backend_elapsed_sec": 0.5492942000055336, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.862408424908425, - "inlier_rmse_m": 0.37341451021933614, - "target_points": 3848, - "source_points": 4368 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7723163122373615, - "inlier_rmse_m": 0.1940923603503706, - "target_points": 7048, - "source_points": 7853 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6562720225510923, - "inlier_rmse_m": 0.12383212781136702, - "target_points": 10219, - "source_points": 11352 - } - ], - "heldout_symmetric": { - "evaluated": 8039, - "inliers": 5862, - "inlier_ratio": 0.729195173529046, - "inlier_rmse_m": 0.10869447817964137, - "median_m": 0.11288663205582093, - "p90_m": 0.8551764208111066, - "p95_m": 1.4379578644737843 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2945.4301764789543, - 4497.287226498696, - 5157.907793702524, - 7449.999999999999, - 10359.624448102222, - 12731.274666553983 - ], - "effective_rank": 6, - "scaled_condition_number": 4.322382098282597, - "weakest_scaled_direction": [ - 0.31452643113840917, - 0.7270653153013035, - -0.003981665513626549, - -0.08548678659790035, - 0.0336773708641118, - -0.6033167839118476 - ] - }, - "forward_reverse": { - "translation_m": 0.0028206125960216254, - "rotation_deg": 0.014140069566934874 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.738317519180803e-15, - "rotation_deg": 3.181982304998891e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 5391, - "frame_counter_j": 7268, - "rtk_translation_m": 2.8783779741216167, - "rtk_rotation_deg": 57.12161955993242, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5445166366166764, - 0.8384908273650975, - -0.020851016096519855, - -3.4538865183935354 - ], - [ - -0.8387292843693261, - 0.5445097777539537, - -0.006503035572538104, - -1.1484295272772398 - ], - [ - 0.005900846463058012, - 0.02102936886676444, - 0.9997614443736491, - -0.10025857848425088 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7263, - "backend_objective": 105.35073437786957, - "backend_elapsed_sec": 0.27849219999916386, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.83882378952023, - "inlier_rmse_m": 0.4069905972230612, - "target_points": 3848, - "source_points": 4523 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7231163130943672, - "inlier_rmse_m": 0.1951378475995885, - "target_points": 7048, - "source_points": 8202 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6135326913329955, - "inlier_rmse_m": 0.12043723088714241, - "target_points": 10219, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 5645, - "inlier_ratio": 0.6945982527377876, - "inlier_rmse_m": 0.10596349826421764, - "median_m": 0.11679942446690253, - "p90_m": 1.0453516193281576, - "p95_m": 1.6940689752490985 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2935.262045719982, - 4440.47801701173, - 5009.964206511484, - 7262.999999999999, - 10665.800422154674, - 13188.678979664546 - ], - "effective_rank": 6, - "scaled_condition_number": 4.493186221276381, - "weakest_scaled_direction": [ - -0.25364960310734164, - -0.7219005896133442, - 0.005788190767641299, - 0.08718115259507365, - -0.0255218882012589, - 0.6373664520994711 - ] - }, - "forward_reverse": { - "translation_m": 0.005660464094292755, - "rotation_deg": 0.08952914345108036 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.836725210897304e-15, - "rotation_deg": 1.9366491697468578e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 5391, - "frame_counter_j": 7942, - "rtk_translation_m": 3.84803303865234, - "rtk_rotation_deg": 78.07081297783375, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.20910073391805267, - 0.9776308404731116, - -0.022689707595504507, - -4.6244216859981915 - ], - [ - -0.9778903254304855, - 0.20897911139425338, - -0.007631672839370832, - 0.0980744714625282 - ], - [ - -0.002719283801065955, - 0.023783833936225365, - 0.9997134263072109, - -0.16759066261829367 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6997, - "backend_objective": 109.62974325544948, - "backend_elapsed_sec": 0.2657357999996748, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7911515940143136, - "inlier_rmse_m": 0.41720673768867156, - "target_points": 3848, - "source_points": 4611 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6849759615384615, - "inlier_rmse_m": 0.20307457756463013, - "target_points": 7048, - "source_points": 8320 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5763591433278419, - "inlier_rmse_m": 0.1251723084254199, - "target_points": 10219, - "source_points": 12140 - } - ], - "heldout_symmetric": { - "evaluated": 8108, - "inliers": 5295, - "inlier_ratio": 0.6530587074494326, - "inlier_rmse_m": 0.1098871098886565, - "median_m": 0.1337673185195989, - "p90_m": 1.3169940403399378, - "p95_m": 2.1080831523883883 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2609.8760413582168, - 4025.5537444992633, - 4469.8111195734355, - 6997.0000000000055, - 10726.730137939563, - 13041.827142763399 - ], - "effective_rank": 6, - "scaled_condition_number": 4.997105968288151, - "weakest_scaled_direction": [ - 0.14816305558064374, - 0.727833486873062, - -0.005814114690409175, - -0.07379123193356954, - 0.00970624232678126, - -0.6653818177311389 - ] - }, - "forward_reverse": { - "translation_m": 0.009441275754405344, - "rotation_deg": 0.06902225135435515 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1144649932300827e-15, - "rotation_deg": 5.251983818378857e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 6461, - "frame_counter_j": 7268, - "rtk_translation_m": 0.636223282239137, - "rtk_rotation_deg": 20.20192940175253, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9373127480597525, - 0.3484890803886343, - 0.0004161424754952402, - -0.6224418732276717 - ], - [ - -0.34848903352139726, - 0.9373097308066428, - 0.0024211671774105018, - -0.7832134384917555 - ], - [ - 0.00045369593143927803, - -0.0024144119496632486, - 0.9999969823829161, - -0.01579188455114878 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9845, - "backend_objective": 104.76914976161348, - "backend_elapsed_sec": 0.20694899999944028, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9513597170019898, - "inlier_rmse_m": 0.29495001480100685, - "target_points": 4368, - "source_points": 4523 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8902706656912948, - "inlier_rmse_m": 0.1509295727812818, - "target_points": 7853, - "source_points": 8202 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8316438587599256, - "inlier_rmse_m": 0.10315940997352435, - "target_points": 11352, - "source_points": 11838 - } - ], - "heldout_symmetric": { - "evaluated": 8390, - "inliers": 7264, - "inlier_ratio": 0.865792610250298, - "inlier_rmse_m": 0.09248705530398661, - "median_m": 0.06895405476090398, - "p90_m": 0.3564288698726344, - "p95_m": 0.6137563575529236 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4942.290761603409, - 7280.5141978124475, - 8556.086044118074, - 9844.999999999996, - 12629.35147026834, - 16991.840804609954 - ], - "effective_rank": 6, - "scaled_condition_number": 3.4380496057859116, - "weakest_scaled_direction": [ - -0.3606698084540075, - 0.7168869269316482, - -0.01839824498711643, - -0.14092904550428814, - -0.08561067974613533, - -0.5731158203123483 - ] - }, - "forward_reverse": { - "translation_m": 0.007654923324833218, - "rotation_deg": 0.03083951917063289 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.633607144361455e-15, - "rotation_deg": 2.174323529658602e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 6461, - "frame_counter_j": 7942, - "rtk_translation_m": 2.0145868546459504, - "rtk_rotation_deg": 41.151122819653864, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7509822192442668, - 0.6603224040204736, - 0.0001706680308637707, - -2.309316386632143 - ], - [ - -0.6603219689659727, - 0.7509813701720836, - 0.0013707499276706225, - -0.4835308116636222 - ], - [ - 0.0007769683758877146, - -0.0011421046728905214, - 0.9999990459580762, - -0.05619783464273758 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9190, - "backend_objective": 128.5202722291167, - "backend_elapsed_sec": 0.5530448999998043, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9084797224029495, - "inlier_rmse_m": 0.353514794960377, - "target_points": 4368, - "source_points": 4611 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8219951923076924, - "inlier_rmse_m": 0.17198770762270238, - "target_points": 7853, - "source_points": 8320 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.757001647446458, - "inlier_rmse_m": 0.11825732819734243, - "target_points": 11352, - "source_points": 12140 - } - ], - "heldout_symmetric": { - "evaluated": 8371, - "inliers": 6879, - "inlier_ratio": 0.8217656194003106, - "inlier_rmse_m": 0.10443913508460159, - "median_m": 0.09087887067006485, - "p90_m": 0.5036314075723249, - "p95_m": 0.947682374018084 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4059.7210524972647, - 6430.640511848307, - 7352.636833269932, - 9190.0, - 12316.198564753844, - 16068.250094697694 - ], - "effective_rank": 6, - "scaled_condition_number": 3.957969004992005, - "weakest_scaled_direction": [ - -0.34556905260299997, - 0.7085021373971045, - -0.01652556765595689, - -0.11080231983454517, - -0.06806581871827784, - -0.6011851187795166 - ] - }, - "forward_reverse": { - "translation_m": 0.0019958122994113434, - "rotation_deg": 0.04243931133970266 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3619265071463753e-15, - "rotation_deg": 3.0605656536254846e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 6461, - "frame_counter_j": 9502, - "rtk_translation_m": 1.2405786051647103, - "rtk_rotation_deg": 116.67752660647822, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.458880224173864, - 0.8884290049750687, - -0.011083455289421396, - -3.093595317869866 - ], - [ - -0.8884649249994544, - -0.45893522543057813, - -0.0029216270636623853, - -1.4173660948404052 - ], - [ - -0.007682246276878148, - 0.008506584390524763, - 0.9999343083993812, - -0.05040229559820074 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8169, - "backend_objective": 115.43977125075969, - "backend_elapsed_sec": 0.31595219999871915, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8828386520865878, - "inlier_rmse_m": 0.37009840842201963, - "target_points": 4368, - "source_points": 4481 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7939977769544275, - "inlier_rmse_m": 0.18433556569506937, - "target_points": 7853, - "source_points": 8097 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6939937133633506, - "inlier_rmse_m": 0.11887575294550026, - "target_points": 11352, - "source_points": 11771 - } - ], - "heldout_symmetric": { - "evaluated": 8360, - "inliers": 6239, - "inlier_ratio": 0.7462918660287081, - "inlier_rmse_m": 0.10754571546972236, - "median_m": 0.10735114034100943, - "p90_m": 0.8206764972717392, - "p95_m": 1.2796931866173804 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3146.8279566697283, - 5385.186438730696, - 6027.667011195876, - 8169.0, - 11432.979740271745, - 14537.89753733038 - ], - "effective_rank": 6, - "scaled_condition_number": 4.619857754383166, - "weakest_scaled_direction": [ - -0.34292317741156864, - 0.7015571241943603, - -0.0135414262495399, - -0.08839485889971761, - -0.0550934880374563, - -0.6157832265961672 - ] - }, - "forward_reverse": { - "translation_m": 0.0030226348073827927, - "rotation_deg": 0.05528144266002643 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.418114913644557e-15, - "rotation_deg": 2.6366828714606765e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 7268, - "frame_counter_j": 7942, - "rtk_translation_m": 1.5928240921286525, - "rtk_rotation_deg": 20.949193417901323, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9340297276134362, - 0.35719357609479835, - 0.0011032365929339013, - -1.6829969733127592 - ], - [ - -0.35719157177502375, - 0.9340296497011563, - -0.0016716853839309996, - -0.3066187850277303 - ], - [ - -0.0016275709688272678, - 0.0011673370311386525, - 0.9999979941664866, - -0.03939267554028703 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9685, - "backend_objective": 133.3239274436062, - "backend_elapsed_sec": 0.2836020999966422, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.949685534591195, - "inlier_rmse_m": 0.29837619714207914, - "target_points": 4523, - "source_points": 4611 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8955528846153846, - "inlier_rmse_m": 0.17218258497774752, - "target_points": 8202, - "source_points": 8320 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7977759472817133, - "inlier_rmse_m": 0.11732869406750238, - "target_points": 11838, - "source_points": 12140 - } - ], - "heldout_symmetric": { - "evaluated": 8459, - "inliers": 7061, - "inlier_ratio": 0.8347322378531742, - "inlier_rmse_m": 0.10791137431619166, - "median_m": 0.09148392996526837, - "p90_m": 0.38685125593567476, - "p95_m": 0.6731389754358754 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5113.861718444385, - 7884.866547987189, - 9271.860927320415, - 9685.0, - 12118.48140466193, - 17175.04818965349 - ], - "effective_rank": 6, - "scaled_condition_number": 3.358528082155117, - "weakest_scaled_direction": [ - 0.7139554360251116, - -0.42724516535563883, - 0.031505837134431634, - 0.07528327919489947, - 0.16440637812162637, - 0.5234878766346703 - ] - }, - "forward_reverse": { - "translation_m": 0.0033753816186126483, - "rotation_deg": 0.015427430722607398 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7433125689005187e-15, - "rotation_deg": 1.0000502644324813e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 7268, - "frame_counter_j": 9502, - "rtk_translation_m": 0.6774809171975742, - "rtk_rotation_deg": 96.47559720472566, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1207662602513995, - 0.9926492425077496, - -0.007936733186902726, - -2.0978392180475858 - ], - [ - -0.992629423793888, - -0.12083760723771174, - -0.009224949629762268, - -1.4548412247304416 - ], - [ - -0.010116195109745133, - 0.006764172222327199, - 0.9999259515437389, - -0.03717216588287199 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8605, - "backend_objective": 115.73862011435307, - "backend_elapsed_sec": 0.48427100000117207, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9265788886409284, - "inlier_rmse_m": 0.3363154043547717, - "target_points": 4523, - "source_points": 4481 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8490799061380758, - "inlier_rmse_m": 0.18230142641617547, - "target_points": 8202, - "source_points": 8097 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7310338968651772, - "inlier_rmse_m": 0.11597482150471675, - "target_points": 11838, - "source_points": 11771 - } - ], - "heldout_symmetric": { - "evaluated": 8448, - "inliers": 6443, - "inlier_ratio": 0.7626657196969697, - "inlier_rmse_m": 0.10926443071446633, - "median_m": 0.10335986776444447, - "p90_m": 0.5961494538884637, - "p95_m": 1.035547032049845 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3813.668566854895, - 6252.637625654872, - 7185.358464866101, - 8605.000000000002, - 11082.727606484385, - 14674.820435422302 - ], - "effective_rank": 6, - "scaled_condition_number": 3.847953795189004, - "weakest_scaled_direction": [ - 0.6224550626133072, - -0.5208809656584741, - 0.019731415102434067, - 0.07660128076715056, - 0.11304096330431214, - 0.5676243214485092 - ] - }, - "forward_reverse": { - "translation_m": 0.0011083901763643633, - "rotation_deg": 0.03408686226954418 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4657376607108497e-15, - "rotation_deg": 4.4714489034690276e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 7268, - "frame_counter_j": 11146, - "rtk_translation_m": 1.8892292086221258, - "rtk_rotation_deg": 131.14857460490867, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6532553338013135, - 0.7565130954543562, - -0.030747443246613652, - -2.00491438136075 - ], - [ - -0.7554314971909387, - -0.6539703390613547, - -0.040571525480732416, - 0.8974991479336777 - ], - [ - -0.05080080621399182, - -0.0032759783341615913, - 0.9987034324833185, - -0.03616284863059511 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8556, - "backend_objective": 111.17055352391041, - "backend_elapsed_sec": 0.22226249999948777, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9087230215827338, - "inlier_rmse_m": 0.3305872290481048, - "target_points": 4523, - "source_points": 4448 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8381094157052474, - "inlier_rmse_m": 0.1845852389590935, - "target_points": 8202, - "source_points": 8061 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7271800101988781, - "inlier_rmse_m": 0.11398809510474757, - "target_points": 11838, - "source_points": 11766 - } - ], - "heldout_symmetric": { - "evaluated": 8574, - "inliers": 6349, - "inlier_ratio": 0.7404945183111733, - "inlier_rmse_m": 0.10470183850479874, - "median_m": 0.09914573180886588, - "p90_m": 0.706464323309998, - "p95_m": 1.3526291416213234 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4099.735199984528, - 6059.909200643516, - 7486.7291422000735, - 8556.0, - 10064.258052358984, - 13040.026242301723 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1806996321008576, - "weakest_scaled_direction": [ - -0.5763329117170823, - 0.6534641722890843, - -0.04094079637797516, - -0.10244723109540384, - -0.11936523558626101, - -0.4630392067336312 - ] - }, - "forward_reverse": { - "translation_m": 0.008442575945215317, - "rotation_deg": 0.02844707164454242 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.703764294054371e-15, - "rotation_deg": 1.1963758672594231e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 7942, - "frame_counter_j": 9502, - "rtk_translation_m": 0.9721300146850552, - "rtk_rotation_deg": 75.52640378682433, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2415179174812429, - 0.9703839471437721, - -0.004908223833257635, - 0.020498848198364703 - ], - [ - -0.9703783652378221, - 0.24147954693950607, - -0.0073114080903765, - -1.225652776694927 - ], - [ - -0.005909637374385715, - 0.006528670275381103, - 0.9999612255735413, - 0.0026512822941567047 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9350, - "backend_objective": 136.72064084614465, - "backend_elapsed_sec": 0.2710284999993746, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9680874804731087, - "inlier_rmse_m": 0.2751909320638482, - "target_points": 4611, - "source_points": 4481 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9234284302828208, - "inlier_rmse_m": 0.17767531971028666, - "target_points": 8320, - "source_points": 8097 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7943250361056835, - "inlier_rmse_m": 0.1209236471197538, - "target_points": 12140, - "source_points": 11771 - } - ], - "heldout_symmetric": { - "evaluated": 8429, - "inliers": 6860, - "inlier_ratio": 0.8138569225293629, - "inlier_rmse_m": 0.1125369920515294, - "median_m": 0.10236046441900606, - "p90_m": 0.38330216813289814, - "p95_m": 0.5316616791386761 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4580.586807970391, - 7191.904902661821, - 8507.506899453714, - 9350.0, - 11161.652574664104, - 14725.549002584721 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2147734820704015, - "weakest_scaled_direction": [ - 0.8678621360320791, - -0.26985193683460496, - 0.017872912110054373, - 0.039782854776910286, - 0.15347085763129872, - 0.3854086459394344 - ] - }, - "forward_reverse": { - "translation_m": 0.005457899756974233, - "rotation_deg": 0.04250371025579654 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4118446352516448e-15, - "rotation_deg": 8.916948353013796e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 7942, - "frame_counter_j": 11146, - "rtk_translation_m": 2.426469315960194, - "rtk_rotation_deg": 110.19938118700728, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3404260196786546, - 0.9401380119751092, - -0.015831726540047147, - -0.7269059808792052 - ], - [ - -0.9389386284463233, - -0.3407914648537047, - -0.047491362311526016, - 1.0089514786661058 - ], - [ - -0.050043752228293624, - -0.0013022758373805142, - 0.9987461774347658, - 0.009481819320967859 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9294, - "backend_objective": 117.34596955670727, - "backend_elapsed_sec": 0.24556960000336403, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9330035971223022, - "inlier_rmse_m": 0.2912616271447972, - "target_points": 4611, - "source_points": 4448 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8809080759211017, - "inlier_rmse_m": 0.16713702397816743, - "target_points": 8320, - "source_points": 8061 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7899031106578276, - "inlier_rmse_m": 0.1123654394828643, - "target_points": 12140, - "source_points": 11766 - } - ], - "heldout_symmetric": { - "evaluated": 8555, - "inliers": 6719, - "inlier_ratio": 0.7853886616014026, - "inlier_rmse_m": 0.10710393317615087, - "median_m": 0.09355700750444025, - "p90_m": 0.5559721579783525, - "p95_m": 1.0551643746608248 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5544.194827946377, - 7265.277874182963, - 9294.0, - 9508.28942563899, - 9808.989454649887, - 13508.849914679671 - ], - "effective_rank": 6, - "scaled_condition_number": 2.4365756135744383, - "weakest_scaled_direction": [ - 0.9187134964310054, - -0.22546025120457336, - 0.02698427829942303, - 0.051965766983725056, - 0.23725743578593753, - 0.2131044428279749 - ] - }, - "forward_reverse": { - "translation_m": 0.0023363953219779758, - "rotation_deg": 0.003679886698275418 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3904303745331937e-15, - "rotation_deg": 6.259932200132295e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 7942, - "frame_counter_j": 12282, - "rtk_translation_m": 4.157137927296689, - "rtk_rotation_deg": 135.66277163100625, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7117515166188437, - 0.7019231467752881, - -0.026714689065263572, - -0.4022448950960343 - ], - [ - -0.7011967341437416, - -0.7122403945021629, - -0.032198764969394104, - 2.8427492399827408 - ], - [ - -0.041628339108440944, - -0.004185267073991601, - 0.9991243991228485, - 0.04387212281117938 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8343, - "backend_objective": 108.46115155470756, - "backend_elapsed_sec": 0.35595720000128495, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9145739910313901, - "inlier_rmse_m": 0.35270672713425366, - "target_points": 4611, - "source_points": 4460 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8236099017290708, - "inlier_rmse_m": 0.184136684643014, - "target_points": 8320, - "source_points": 8039 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7187903851124322, - "inlier_rmse_m": 0.11401867341543448, - "target_points": 12140, - "source_points": 11607 - } - ], - "heldout_symmetric": { - "evaluated": 8346, - "inliers": 6227, - "inlier_ratio": 0.7461059190031153, - "inlier_rmse_m": 0.10791684095774041, - "median_m": 0.10472960901227793, - "p90_m": 0.7588830952578203, - "p95_m": 1.4935071672275044 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4249.46027216821, - 5037.0318898785745, - 8343.0, - 8357.222918235066, - 8490.768640683313, - 9408.873248652648 - ], - "effective_rank": 6, - "scaled_condition_number": 2.2141337125272007, - "weakest_scaled_direction": [ - -0.2890077262047696, - 0.940298371614473, - -0.028073806176326925, - -0.15426990725741266, - -0.04958294328539899, - -0.07257889080055409 - ] - }, - "forward_reverse": { - "translation_m": 0.0023169831632091926, - "rotation_deg": 0.02473862097872449 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.637546502361832e-15, - "rotation_deg": 1.7808666157514636e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 9502, - "frame_counter_j": 11146, - "rtk_translation_m": 2.176233486689304, - "rtk_rotation_deg": 34.672977400182965, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8291991809676471, - 0.5579111770760357, - 0.03411505204767933, - -2.3458514739683816 - ], - [ - -0.5576981074239024, - 0.8298826879679007, - -0.016356808581430828, - -0.19010931608135373 - ], - [ - -0.03743713742236647, - -0.0054628476826916635, - 0.9992840527281591, - -0.019294057118897926 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8732, - "backend_objective": 116.59003912163222, - "backend_elapsed_sec": 0.2578651000003447, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8878147482014388, - "inlier_rmse_m": 0.3238703569154529, - "target_points": 4481, - "source_points": 4448 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8286813050490014, - "inlier_rmse_m": 0.172736329778459, - "target_points": 8097, - "source_points": 8061 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7421383647798742, - "inlier_rmse_m": 0.11555104049474128, - "target_points": 11771, - "source_points": 11766 - } - ], - "heldout_symmetric": { - "evaluated": 8544, - "inliers": 6371, - "inlier_ratio": 0.7456694756554307, - "inlier_rmse_m": 0.11049010248131722, - "median_m": 0.11069962047347812, - "p90_m": 0.6695354690865016, - "p95_m": 1.3578550495482498 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4702.974857872415, - 6165.056546880924, - 8732.0, - 8864.023281637703, - 9006.681887776105, - 10993.756179507674 - ], - "effective_rank": 6, - "scaled_condition_number": 2.3376174680383377, - "weakest_scaled_direction": [ - 0.6365067039413284, - 0.7450292947953677, - 0.03245928228166052, - -0.14959211604482625, - 0.12723231857301953, - 0.013080392042572985 - ] - }, - "forward_reverse": { - "translation_m": 0.0027632919724097076, - "rotation_deg": 0.05272762900968177 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.938893903907228e-16, - "rotation_deg": 1.158567366708465e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 9502, - "frame_counter_j": 12282, - "rtk_translation_m": 3.79947855245853, - "rtk_rotation_deg": 60.13636784418198, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5085815349217666, - 0.8608550964669754, - 0.016532550421946398, - -4.046756328064073 - ], - [ - -0.8604679133365938, - 0.5088490213663148, - -0.02583879975367702, - 0.5665001579851712 - ], - [ - -0.0306560345574392, - -0.001084592724443027, - 0.9995294048720307, - -0.003921780951718637 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8088, - "backend_objective": 109.54475310750554, - "backend_elapsed_sec": 0.282886499997403, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8816143497757848, - "inlier_rmse_m": 0.3675810265029174, - "target_points": 4481, - "source_points": 4460 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7889040925488244, - "inlier_rmse_m": 0.18354333071366277, - "target_points": 8097, - "source_points": 8039 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6968208839493409, - "inlier_rmse_m": 0.11637916024828983, - "target_points": 11771, - "source_points": 11607 - } - ], - "heldout_symmetric": { - "evaluated": 8335, - "inliers": 5930, - "inlier_ratio": 0.7114577084583084, - "inlier_rmse_m": 0.11170286188791147, - "median_m": 0.11910145697414173, - "p90_m": 0.8518784828615422, - "p95_m": 1.6513531211180523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3756.238153057955, - 4624.24016321459, - 7441.4536391115835, - 8088.0, - 8423.273880722954, - 9315.375858789726 - ], - "effective_rank": 6, - "scaled_condition_number": 2.479974772421199, - "weakest_scaled_direction": [ - 0.987763704050321, - 0.017063407020755594, - 0.04722204920797074, - 0.00016908141957713518, - 0.1377007415282551, - -0.053294093146200705 - ] - }, - "forward_reverse": { - "translation_m": 0.0043726035924820505, - "rotation_deg": 0.11525585711885118 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.589839758910881e-15, - "rotation_deg": 9.455694758109072e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 9502, - "frame_counter_j": 13524, - "rtk_translation_m": 6.190474035537447, - "rtk_rotation_deg": 15.261944565117341, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9656064172081428, - 0.25593808071112034, - -0.04582516653938418, - 6.084903974973151 - ], - [ - -0.25617535241637546, - 0.9666300605967315, - 0.0007174713257949189, - -1.070302913400166 - ], - [ - 0.04447961174290946, - 0.011046483271415419, - 0.9989492176014426, - 0.4868366225916526 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6626, - "backend_objective": 99.5549449658476, - "backend_elapsed_sec": 0.2878296999988379, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8292230177671706, - "inlier_rmse_m": 0.4201930330840916, - "target_points": 4481, - "source_points": 3771 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7202303815694744, - "inlier_rmse_m": 0.19529171388923153, - "target_points": 8097, - "source_points": 6945 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.636381098732232, - "inlier_rmse_m": 0.12257607268880656, - "target_points": 11771, - "source_points": 10412 - } - ], - "heldout_symmetric": { - "evaluated": 8527, - "inliers": 5262, - "inlier_ratio": 0.6170986278878855, - "inlier_rmse_m": 0.11803645680912848, - "median_m": 0.15845714324045926, - "p90_m": 1.5940128982969806, - "p95_m": 2.6020814777408723 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2114.7074725744465, - 2896.903334994711, - 3653.2418817271696, - 6626.0, - 9634.655448844787, - 11010.069054072055 - ], - "effective_rank": 6, - "scaled_condition_number": 5.206426513766648, - "weakest_scaled_direction": [ - -0.1900381400124806, - -0.7674730911608907, - -0.007987721013430354, - 0.10707770013389169, - -0.02024402168947157, - -0.6024377990443732 - ] - }, - "forward_reverse": { - "translation_m": 0.02802927019183766, - "rotation_deg": 0.10048860643286558 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3414875847488985e-15, - "rotation_deg": 2.3440754889511216e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 11146, - "frame_counter_j": 12282, - "rtk_translation_m": 1.7328875589135755, - "rtk_rotation_deg": 25.463390443999018, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9027998487886799, - 0.4299130501430412, - -0.011278401652936153, - -1.8337981024793115 - ], - [ - -0.4300514858998464, - 0.9026435650195853, - -0.01703860334851563, - -0.31904740605758236 - ], - [ - 0.0028552587399912803, - 0.020232741916030663, - 0.9997912200315059, - -0.05233688999403972 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8660, - "backend_objective": 101.62993488457431, - "backend_elapsed_sec": 0.2127452999993693, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9372197309417041, - "inlier_rmse_m": 0.3429992332321203, - "target_points": 4448, - "source_points": 4460 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8476178629182735, - "inlier_rmse_m": 0.17756658425465105, - "target_points": 8061, - "source_points": 8039 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7461014904798828, - "inlier_rmse_m": 0.10833078187089373, - "target_points": 11766, - "source_points": 11607 - } - ], - "heldout_symmetric": { - "evaluated": 8461, - "inliers": 6504, - "inlier_ratio": 0.7687034629476421, - "inlier_rmse_m": 0.09834033850996364, - "median_m": 0.08327272725905262, - "p90_m": 0.5528239752181396, - "p95_m": 0.9852507812495924 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4409.00210388048, - 5165.217616845061, - 8115.8232556388675, - 8660.000000000002, - 9047.009599993982, - 10462.371266167567 - ], - "effective_rank": 6, - "scaled_condition_number": 2.3729567416081196, - "weakest_scaled_direction": [ - 0.9124230514045486, - 0.33143736830035647, - 0.04618378686757995, - -0.04431528461521425, - 0.1469059517756101, - -0.17876045668069665 - ] - }, - "forward_reverse": { - "translation_m": 0.004926598691892943, - "rotation_deg": 0.10049788043616295 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.08995101411847e-16, - "rotation_deg": 1.033329895657601e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 11146, - "frame_counter_j": 13524, - "rtk_translation_m": 8.352264787019024, - "rtk_rotation_deg": 19.411032835065622, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9420716305722148, - -0.32687364175136246, - -0.07519750793217365, - 7.461193745446546 - ], - [ - 0.32570593186725577, - 0.9450667730495927, - -0.0276485157669705, - 3.9684321950400054 - ], - [ - 0.08010423720059975, - 0.0015546079363475214, - 0.9967852799759204, - 0.8211267142081754 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5660, - "backend_objective": 101.28357208687935, - "backend_elapsed_sec": 0.39066060000186553, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.809334394059931, - "inlier_rmse_m": 0.4700524019954877, - "target_points": 4448, - "source_points": 3771 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6558675305975522, - "inlier_rmse_m": 0.21489836750401572, - "target_points": 8061, - "source_points": 6945 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5436035343834038, - "inlier_rmse_m": 0.1337707892015976, - "target_points": 11766, - "source_points": 10412 - } - ], - "heldout_symmetric": { - "evaluated": 8653, - "inliers": 4843, - "inlier_ratio": 0.5596902808274586, - "inlier_rmse_m": 0.12817180913542037, - "median_m": 0.19755896000719822, - "p90_m": 1.866779382860181, - "p95_m": 2.8054030176357956 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1410.5236990655822, - 2284.883691109894, - 2528.0009694356504, - 5660.0, - 10528.684594919043, - 11908.398734725986 - ], - "effective_rank": 6, - "scaled_condition_number": 8.442537153126064, - "weakest_scaled_direction": [ - 0.2683126923459586, - -0.6411343839679067, - 0.0006836776415267775, - 0.10605865530816341, - 0.0436283189660922, - -0.7097905781450302 - ] - }, - "forward_reverse": { - "translation_m": 0.04660873899639204, - "rotation_deg": 0.08128930035257874 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.021666937153402e-16, - "rotation_deg": 5.227573732801378e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 11146, - "frame_counter_j": 14726, - "rtk_translation_m": 6.346037230040679, - "rtk_rotation_deg": 25.592965647994788, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8969380966924445, - 0.4341517018303386, - -0.08375171938268235, - 5.813421974152195 - ], - [ - -0.4389147786432966, - 0.8971378741324569, - -0.04997451235981982, - 1.693344712812893 - ], - [ - 0.05344031989276062, - 0.08158391137299532, - 0.9952327354015442, - 0.5474025437268137 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6456, - "backend_objective": 102.49901592947957, - "backend_elapsed_sec": 0.4368594999978086, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8345441762362316, - "inlier_rmse_m": 0.4313797716288856, - "target_points": 4448, - "source_points": 4267 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7095288233745722, - "inlier_rmse_m": 0.2079419833574955, - "target_points": 8061, - "source_points": 7598 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5938189845474614, - "inlier_rmse_m": 0.1260021881322215, - "target_points": 11766, - "source_points": 10872 - } - ], - "heldout_symmetric": { - "evaluated": 8271, - "inliers": 5074, - "inlier_ratio": 0.6134687462217386, - "inlier_rmse_m": 0.11861991782546771, - "median_m": 0.16267504186000523, - "p90_m": 1.733266640994018, - "p95_m": 2.6894083395718313 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2000.1487662906395, - 2798.6309750626697, - 3336.863004059452, - 6455.999999999999, - 10405.595608276246, - 11868.167076555905 - ], - "effective_rank": 6, - "scaled_condition_number": 5.933642175309751, - "weakest_scaled_direction": [ - 0.12976693073539752, - -0.7510266721829234, - -0.031247683518592795, - 0.11135813975446635, - 0.04567546060876612, - -0.6353394216013053 - ] - }, - "forward_reverse": { - "translation_m": 0.006137337753783083, - "rotation_deg": 0.040498570689394164 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5341311739065124e-15, - "rotation_deg": 1.9397991388099636e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 12282, - "frame_counter_j": 13524, - "rtk_translation_m": 9.849975560032544, - "rtk_rotation_deg": 44.87442327906463, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7103688222709044, - -0.7015541133662828, - -0.05655052930164605, - 6.548956783220116 - ], - [ - 0.7005783317338852, - 0.7125152212952316, - -0.03888522248329848, - 7.891325087902238 - ], - [ - 0.06757320068204592, - -0.011995225777612552, - 0.9976422089647822, - 0.6917959574001291 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5815, - "backend_objective": 102.06921084199112, - "backend_elapsed_sec": 0.5862409000037587, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7756563245823389, - "inlier_rmse_m": 0.4625756935269843, - "target_points": 4460, - "source_points": 3771 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6581713462922966, - "inlier_rmse_m": 0.21359761502312047, - "target_points": 8039, - "source_points": 6945 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5584902036112178, - "inlier_rmse_m": 0.13248677205956727, - "target_points": 11607, - "source_points": 10412 - } - ], - "heldout_symmetric": { - "evaluated": 8444, - "inliers": 4979, - "inlier_ratio": 0.589649455234486, - "inlier_rmse_m": 0.12715782204597983, - "median_m": 0.18024684717370038, - "p90_m": 1.7404430345105053, - "p95_m": 2.6940079016130523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1341.672354825345, - 2071.4501538935588, - 2249.4252882995493, - 5815.000000000001, - 12378.765159388387, - 13740.018810426953 - ], - "effective_rank": 6, - "scaled_condition_number": 10.240964391202342, - "weakest_scaled_direction": [ - -0.47002463658505594, - 0.43694106044433056, - -0.006370753349259413, - -0.06432506792778911, - -0.058085653073818855, - 0.7619757914433405 - ] - }, - "forward_reverse": { - "translation_m": 0.016491489842564398, - "rotation_deg": 0.29283865924681673 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.49419213904715e-15, - "rotation_deg": 7.867744205466391e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 12282, - "frame_counter_j": 14726, - "rtk_translation_m": 7.9099649541476005, - "rtk_rotation_deg": 0.12957520399577063, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9987825221074151, - 0.0060042368911197574, - -0.04896348304713356, - 6.036532021851093 - ], - [ - -0.009062589742234917, - 0.9980049936870143, - -0.0624812135201224, - 5.124926486072822 - ], - [ - 0.04849064858212929, - 0.06284887998316677, - 0.9968443586061694, - 0.4812780500745405 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6719, - "backend_objective": 106.89294019739114, - "backend_elapsed_sec": 0.24119380000047386, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7745488633700492, - "inlier_rmse_m": 0.4176670187608849, - "target_points": 4460, - "source_points": 4267 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7012371676757041, - "inlier_rmse_m": 0.1948839316868815, - "target_points": 8039, - "source_points": 7598 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.618009565857248, - "inlier_rmse_m": 0.12613110222409377, - "target_points": 11607, - "source_points": 10872 - } - ], - "heldout_symmetric": { - "evaluated": 8062, - "inliers": 5193, - "inlier_ratio": 0.6441329694864798, - "inlier_rmse_m": 0.11977657776801591, - "median_m": 0.15184086648949194, - "p90_m": 1.7064248770368182, - "p95_m": 2.8167921292749765 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1721.025287689701, - 2511.484173988603, - 2841.885668662257, - 6718.999999999998, - 12347.453815221807, - 13722.802817630902 - ], - "effective_rank": 6, - "scaled_condition_number": 7.973620675877663, - "weakest_scaled_direction": [ - 0.26037859160420485, - -0.6962928792340143, - -0.035857571073403795, - 0.06270637637148625, - 0.057564074633910584, - -0.6624558382509981 - ] - }, - "forward_reverse": { - "translation_m": 0.01581702082704062, - "rotation_deg": 0.07681086634765077 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.0474634163828865e-15, - "rotation_deg": 5.498612512743909e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 12282, - "frame_counter_j": 15687, - "rtk_translation_m": 6.609737623005951, - "rtk_rotation_deg": 34.172763646089344, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8322826826929584, - 0.5523245189283951, - -0.047362029938864694, - 2.47384620010309 - ], - [ - -0.5542014769093111, - 0.8270279163107381, - -0.09426318811846424, - 5.309067290829172 - ], - [ - -0.012894149097601445, - 0.1047017260279683, - 0.9944200769724095, - 0.24456615357094227 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7100, - "backend_objective": 117.28165405961984, - "backend_elapsed_sec": 0.2966292999990401, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7888816785637032, - "inlier_rmse_m": 0.40260719111358834, - "target_points": 4460, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7019137596899225, - "inlier_rmse_m": 0.19609454482575353, - "target_points": 8039, - "source_points": 8256 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6079287610240602, - "inlier_rmse_m": 0.12852448336911754, - "target_points": 11607, - "source_points": 11679 - } - ], - "heldout_symmetric": { - "evaluated": 8018, - "inliers": 5148, - "inlier_ratio": 0.642055375405338, - "inlier_rmse_m": 0.11922626532224312, - "median_m": 0.1513914055445305, - "p90_m": 1.6460751941527245, - "p95_m": 2.6292669064173246 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2503.530347157266, - 3446.311334048123, - 3944.6148492901766, - 7099.999999999997, - 12233.177071313363, - 14246.899483833455 - ], - "effective_rank": 6, - "scaled_condition_number": 5.690723701436521, - "weakest_scaled_direction": [ - -0.4299826280275845, - 0.5799440489767264, - 0.01172048206969977, - -0.09137928908997309, - -0.08151162869840498, - 0.6809171387646008 - ] - }, - "forward_reverse": { - "translation_m": 0.01936736899083179, - "rotation_deg": 0.22155509936605944 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.323103535694436e-15, - "rotation_deg": 3.5326322199007284e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 13524, - "frame_counter_j": 14726, - "rtk_translation_m": 2.081596655954183, - "rtk_rotation_deg": 45.003998483060414, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7060147105471561, - 0.7081274813076114, - -0.009934722339114506, - -2.325812612507912 - ], - [ - -0.7081728441328697, - 0.7058047271156785, - -0.01819093218957285, - -1.6158370009592502 - ], - [ - -0.005869525004511017, - 0.019878566298965287, - 0.9997851725636459, - -0.050118670501694496 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7273, - "backend_objective": 94.9445063590489, - "backend_elapsed_sec": 0.21070999999938067, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8769627372861495, - "inlier_rmse_m": 0.33594866152049524, - "target_points": 3771, - "source_points": 4267 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7958673335088181, - "inlier_rmse_m": 0.18784987936925085, - "target_points": 6945, - "source_points": 7598 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6689661515820456, - "inlier_rmse_m": 0.11425576609132701, - "target_points": 10412, - "source_points": 10872 - } - ], - "heldout_symmetric": { - "evaluated": 8254, - "inliers": 6283, - "inlier_ratio": 0.761206687666586, - "inlier_rmse_m": 0.10248796635270672, - "median_m": 0.09623494656283642, - "p90_m": 0.736437473230707, - "p95_m": 1.6077341006930361 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2422.1868451385817, - 5573.55885044467, - 6315.220040789463, - 7273.000000000002, - 8812.484305976748, - 11574.472847176667 - ], - "effective_rank": 6, - "scaled_condition_number": 4.778521884225018, - "weakest_scaled_direction": [ - 0.3032949699263246, - 0.8312394083206524, - 0.01688631871835394, - -0.08671387109850442, - 0.04089481368772959, - -0.45560550730299826 - ] - }, - "forward_reverse": { - "translation_m": 0.003602819302929225, - "rotation_deg": 0.04280787772842571 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2614235166153577e-15, - "rotation_deg": 3.362074287560205e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 13524, - "frame_counter_j": 15687, - "rtk_translation_m": 4.34928579963815, - "rtk_rotation_deg": 79.047186925154, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2020701296104395, - 0.9787359077510795, - -0.035265926868446325, - -4.731461974243498 - ], - [ - -0.9788940502964261, - 0.2007170083106466, - -0.03845934046608828, - 1.018697798314426 - ], - [ - -0.03056306616624813, - 0.04229308990242541, - 0.9986376687933549, - -0.14584576686881853 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6396, - "backend_objective": 86.7352248292678, - "backend_elapsed_sec": 0.6253508000008878, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7890979883192732, - "inlier_rmse_m": 0.43390619653359513, - "target_points": 3771, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6626695736434108, - "inlier_rmse_m": 0.20176353537149613, - "target_points": 6945, - "source_points": 8256 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5476496275366042, - "inlier_rmse_m": 0.11645108163336905, - "target_points": 10412, - "source_points": 11679 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 5463, - "inlier_ratio": 0.6654080389768575, - "inlier_rmse_m": 0.10560001932239894, - "median_m": 0.12126712377558782, - "p90_m": 1.255904615890748, - "p95_m": 2.0886942293209505 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2245.8944674453774, - 4007.7268570429655, - 4507.580176259234, - 6395.999999999999, - 8438.207997568927, - 10437.831638352885 - ], - "effective_rank": 6, - "scaled_condition_number": 4.647516519431804, - "weakest_scaled_direction": [ - 0.46801389486608974, - 0.6711695203141902, - 0.0276295679678338, - -0.058803899016418776, - 0.06436915030929925, - -0.5675647893732748 - ] - }, - "forward_reverse": { - "translation_m": 0.015683211248127868, - "rotation_deg": 0.18051709633786264 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.9026812296057035e-15, - "rotation_deg": 1.1812569766049972e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 13524, - "frame_counter_j": 17122, - "rtk_translation_m": 4.4206846692505035, - "rtk_rotation_deg": 169.37257900760153, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9817409515215186, - 0.17513334924547225, - -0.07424967399043934, - -3.936058984907175 - ], - [ - -0.17374336051370867, - -0.9844777877686548, - -0.024834050566483815, - 3.949898122046015 - ], - [ - -0.0774464252436913, - -0.011480216557127127, - 0.9969304167517268, - -0.05477427646441862 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6349, - "backend_objective": 98.11787874591228, - "backend_elapsed_sec": 0.5364952000018093, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.785908425674263, - "inlier_rmse_m": 0.43784258641758095, - "target_points": 3771, - "source_points": 4783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6573839662447257, - "inlier_rmse_m": 0.20730899335988143, - "target_points": 6945, - "source_points": 8295 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5414463585195293, - "inlier_rmse_m": 0.12431439240770303, - "target_points": 10412, - "source_points": 11726 - } - ], - "heldout_symmetric": { - "evaluated": 8274, - "inliers": 5277, - "inlier_ratio": 0.6377810007251632, - "inlier_rmse_m": 0.11215519048187066, - "median_m": 0.14335790589373204, - "p90_m": 1.2433212241938114, - "p95_m": 1.9449252988559254 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2257.7633730357566, - 3877.5798061110263, - 4391.68219364514, - 6349.0, - 9558.841272386477, - 11692.350679853662 - ], - "effective_rank": 6, - "scaled_condition_number": 5.178731668470772, - "weakest_scaled_direction": [ - 0.38471937585826815, - 0.7052113598018347, - 0.014800878033908312, - -0.07624360260028426, - 0.053934315501207086, - -0.5879854390450872 - ] - }, - "forward_reverse": { - "translation_m": 0.016926609942259613, - "rotation_deg": 0.20634229894075337 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2541902238434278e-15, - "rotation_deg": 3.2252243794605045e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 14726, - "frame_counter_j": 15687, - "rtk_translation_m": 3.459222336215112, - "rtk_rotation_deg": 34.04318844209358, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8358588849290913, - 0.5489387879824537, - -0.0024761933387511125, - -3.5668618446006626 - ], - [ - -0.5487921047895475, - 0.8355122916571305, - -0.027320984801243703, - 0.14490977115291656 - ], - [ - -0.012928658312235702, - 0.024195403245371297, - 0.9996236453065923, - -0.10948842042294622 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8127, - "backend_objective": 116.82640290971389, - "backend_elapsed_sec": 0.2666767999980948, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.891196192948302, - "inlier_rmse_m": 0.36962508913561826, - "target_points": 4267, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7995397286821705, - "inlier_rmse_m": 0.18805849538401315, - "target_points": 7598, - "source_points": 8256 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6958643719496532, - "inlier_rmse_m": 0.11989618725869633, - "target_points": 10872, - "source_points": 11679 - } - ], - "heldout_symmetric": { - "evaluated": 7828, - "inliers": 5915, - "inlier_ratio": 0.7556208482370976, - "inlier_rmse_m": 0.10994458141969204, - "median_m": 0.10848448716821275, - "p90_m": 0.8008052138441898, - "p95_m": 1.314934954690247 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3588.4204092955097, - 5250.912767234175, - 6416.747471268891, - 8127.0, - 10457.03791067897, - 12899.862501631891 - ], - "effective_rank": 6, - "scaled_condition_number": 3.594858191146124, - "weakest_scaled_direction": [ - -0.1945534550909183, - 0.8706791161748509, - 0.015343533177179796, - -0.1128312806217235, - -0.017514683226276046, - -0.43679943194051 - ] - }, - "forward_reverse": { - "translation_m": 0.004654350735545165, - "rotation_deg": 0.12873243616635754 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6867411532482615e-15, - "rotation_deg": 3.534145710076262e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 14726, - "frame_counter_j": 17122, - "rtk_translation_m": 4.94806857498194, - "rtk_rotation_deg": 124.36858052454107, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5698071844380652, - 0.8209585252502001, - -0.036699759969049915, - -5.077717975951281 - ], - [ - -0.8196624208806595, - -0.5709757069502303, - -0.04626292110046518, - 2.7771895749875872 - ], - [ - -0.05893461087363614, - 0.003720469285834117, - 0.9982549122090342, - -0.08134583595368532 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7037, - "backend_objective": 108.959379678046, - "backend_elapsed_sec": 0.3699161999975331, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8538574116663182, - "inlier_rmse_m": 0.42264552235239145, - "target_points": 4267, - "source_points": 4783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7164556962025317, - "inlier_rmse_m": 0.2020545585821816, - "target_points": 7598, - "source_points": 8295 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6001193928023196, - "inlier_rmse_m": 0.12443384915795004, - "target_points": 10872, - "source_points": 11726 - } - ], - "heldout_symmetric": { - "evaluated": 7892, - "inliers": 5277, - "inlier_ratio": 0.6686517992904207, - "inlier_rmse_m": 0.11525187440612464, - "median_m": 0.13632670236298036, - "p90_m": 1.0579608239239868, - "p95_m": 1.6629576737082192 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3110.115504889201, - 3974.6107691216394, - 4926.956485038147, - 7036.999999999999, - 11859.49357205418, - 14026.9548179312 - ], - "effective_rank": 6, - "scaled_condition_number": 4.510107356424666, - "weakest_scaled_direction": [ - -0.35520951346828616, - 0.8534848766154005, - -0.022790515989744534, - -0.15127653285284917, - -0.07208493837866063, - -0.34174483401846034 - ] - }, - "forward_reverse": { - "translation_m": 0.022993775653731053, - "rotation_deg": 0.1013964892640344 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1488564258645068e-14, - "rotation_deg": 1.6457442165288727e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 14726, - "frame_counter_j": 18410, - "rtk_translation_m": 6.5847443121227816, - "rtk_rotation_deg": 175.25342056617163, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9946170176581965, - 0.0870741147636196, - -0.05617015865071424, - -7.650140128715779 - ], - [ - -0.08488389423489073, - -0.995576725870179, - -0.04027042842007307, - 4.004785063736034 - ], - [ - -0.05942821454691611, - -0.03528571160892669, - 0.9976087438831004, - -0.1480429963762943 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6432, - "backend_objective": 108.45254269627576, - "backend_elapsed_sec": 0.2512247000049683, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.840440726382371, - "inlier_rmse_m": 0.45350730309436404, - "target_points": 4267, - "source_points": 4901 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6687859884836852, - "inlier_rmse_m": 0.21250648936562072, - "target_points": 7598, - "source_points": 8336 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5459175012731285, - "inlier_rmse_m": 0.12985146430587982, - "target_points": 10872, - "source_points": 11782 - } - ], - "heldout_symmetric": { - "evaluated": 8067, - "inliers": 4764, - "inlier_ratio": 0.5905541093343251, - "inlier_rmse_m": 0.1262853354637165, - "median_m": 0.18226712442594717, - "p90_m": 1.192859395505926, - "p95_m": 1.7488011804587917 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2545.410393238745, - 3006.3779292933446, - 3656.0178559255132, - 6431.999999999999, - 13167.402351670014, - 15125.709076059407 - ], - "effective_rank": 6, - "scaled_condition_number": 5.942345924349615, - "weakest_scaled_direction": [ - -0.011524334799442999, - -0.7418526626064202, - 0.014442118600833187, - 0.12227750406226973, - 0.01092907313920897, - 0.658970416075057 - ] - }, - "forward_reverse": { - "translation_m": 0.021857815102479028, - "rotation_deg": 0.4259066161744867 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.440978833827409e-15, - "rotation_deg": 2.858741689266454e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 15687, - "frame_counter_j": 17122, - "rtk_translation_m": 3.031758915138065, - "rtk_rotation_deg": 90.32539208244746, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.02552123298389634, - 0.9994637197107187, - -0.02051681381199783, - -2.711272681052241 - ], - [ - -0.9989725014621895, - -0.026266829517276755, - -0.03693230279154512, - 1.3689085482587278 - ], - [ - -0.03745140837615766, - 0.019553174911630652, - 0.99910713407598, - -0.05611145271569374 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8307, - "backend_objective": 131.5288903547163, - "backend_elapsed_sec": 0.3732363000017358, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9408321137361488, - "inlier_rmse_m": 0.3564238086875577, - "target_points": 4623, - "source_points": 4783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8397830018083182, - "inlier_rmse_m": 0.1960112906682506, - "target_points": 8256, - "source_points": 8295 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7084257206208425, - "inlier_rmse_m": 0.12583123898616394, - "target_points": 11679, - "source_points": 11726 - } - ], - "heldout_symmetric": { - "evaluated": 7848, - "inliers": 5824, - "inlier_ratio": 0.7420998980632009, - "inlier_rmse_m": 0.12052023632629244, - "median_m": 0.12539304654097416, - "p90_m": 0.6275395805325512, - "p95_m": 0.978716288292877 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3930.6125740785747, - 5795.986316020251, - 7189.828483939545, - 8306.999999999998, - 10593.747781863674, - 13153.38953958267 - ], - "effective_rank": 6, - "scaled_condition_number": 3.3463968507926847, - "weakest_scaled_direction": [ - 0.8578906429920294, - -0.4163925608804803, - 0.027723628342245645, - 0.08449215377916815, - 0.15807926003335063, - -0.24030044494075473 - ] - }, - "forward_reverse": { - "translation_m": 0.012566250876576632, - "rotation_deg": 0.08500209892702067 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.094776105826226e-15, - "rotation_deg": 1.441614523455194e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 15687, - "frame_counter_j": 18410, - "rtk_translation_m": 3.732423384308353, - "rtk_rotation_deg": 141.21023212407198, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7841989034181629, - 0.6193740553435693, - -0.03752145313035003, - -5.543795029368623 - ], - [ - -0.6181172031655323, - -0.7850507320801231, - -0.04032953274317449, - 0.9785965705254549 - ], - [ - -0.05443531049394258, - -0.008433719684925763, - 0.9984816820271191, - -0.14048860846216044 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7506, - "backend_objective": 117.79892545691015, - "backend_elapsed_sec": 0.36653290000685956, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9169557233217711, - "inlier_rmse_m": 0.40780082782245736, - "target_points": 4623, - "source_points": 4901 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7661948176583493, - "inlier_rmse_m": 0.20486875425393536, - "target_points": 8256, - "source_points": 8336 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6370735019521304, - "inlier_rmse_m": 0.1252755691253444, - "target_points": 11679, - "source_points": 11782 - } - ], - "heldout_symmetric": { - "evaluated": 8023, - "inliers": 5227, - "inlier_ratio": 0.6515019319456562, - "inlier_rmse_m": 0.12055764747498063, - "median_m": 0.1507390784505213, - "p90_m": 0.8755175883470401, - "p95_m": 1.3075487655410336 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3467.81429802038, - 4116.865111949869, - 5318.512388516674, - 7505.999999999998, - 11842.62614108797, - 14135.747877242573 - ], - "effective_rank": 6, - "scaled_condition_number": 4.076270140910382, - "weakest_scaled_direction": [ - 0.8836866591739116, - -0.1533606645417574, - 0.06694899395775084, - 0.063046323826182, - 0.19463918084785048, - -0.38631202092128636 - ] - }, - "forward_reverse": { - "translation_m": 0.007120603737667027, - "rotation_deg": 0.05561876226347328 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2585033749746193e-15, - "rotation_deg": 5.103036803136361e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 15687, - "frame_counter_j": 19343, - "rtk_translation_m": 6.37255124464243, - "rtk_rotation_deg": 175.13200822775684, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9941597736637707, - -0.09596423934396753, - -0.04936809897024889, - -8.352146372105251 - ], - [ - 0.09732069799029686, - -0.9949174931067514, - -0.025843058117475035, - 2.761628424625656 - ], - [ - -0.04663717585236047, - -0.030496666659087297, - 0.9984462565161938, - -0.18499023719890995 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6597, - "backend_objective": 109.11671547828271, - "backend_elapsed_sec": 0.5843276999949012, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8372774869109948, - "inlier_rmse_m": 0.4319267161351091, - "target_points": 4623, - "source_points": 4775 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.694017094017094, - "inlier_rmse_m": 0.2094465833188939, - "target_points": 8256, - "source_points": 8190 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5678257875710105, - "inlier_rmse_m": 0.12860930767741743, - "target_points": 11679, - "source_points": 11618 - } - ], - "heldout_symmetric": { - "evaluated": 7852, - "inliers": 4637, - "inlier_ratio": 0.5905501782985226, - "inlier_rmse_m": 0.12548545004843537, - "median_m": 0.17676374938650719, - "p90_m": 1.2330082967254523, - "p95_m": 1.8035096656973177 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2675.244993486525, - 3281.362935372427, - 3963.7389454044273, - 6597.000000000002, - 13101.948378850768, - 15264.352279213419 - ], - "effective_rank": 6, - "scaled_condition_number": 5.705777346141328, - "weakest_scaled_direction": [ - 0.70364065893424, - 0.16844236964950618, - 0.06251728432607732, - 0.02054186845373641, - 0.16203604775799293, - -0.6677806011178669 - ] - }, - "forward_reverse": { - "translation_m": 0.005772061596466365, - "rotation_deg": 0.10356450735473072 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.294643908265779e-15, - "rotation_deg": 1.6403288741271842e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 17122, - "frame_counter_j": 18410, - "rtk_translation_m": 2.057726146362386, - "rtk_rotation_deg": 50.884840041624386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6397648873440721, - 0.7685602493711459, - 0.004003999024517255, - 0.4654588025445307 - ], - [ - -0.7683639445208199, - 0.6397049461514258, - -0.019860277687075465, - -2.8247328072936235 - ], - [ - -0.0178251979521281, - 0.009629379832758233, - 0.9997947476167313, - -0.031694469283866836 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9170, - "backend_objective": 124.98136886478335, - "backend_elapsed_sec": 0.2334673000004841, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9618445215262191, - "inlier_rmse_m": 0.3320141405250623, - "target_points": 4783, - "source_points": 4901 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8714011516314779, - "inlier_rmse_m": 0.17736646691694752, - "target_points": 8295, - "source_points": 8336 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7783058903411985, - "inlier_rmse_m": 0.1167449142897337, - "target_points": 11726, - "source_points": 11782 - } - ], - "heldout_symmetric": { - "evaluated": 8087, - "inliers": 6301, - "inlier_ratio": 0.7791517249907258, - "inlier_rmse_m": 0.1109933103332085, - "median_m": 0.10955629234884867, - "p90_m": 0.5502534415299767, - "p95_m": 0.8708556274371234 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4626.09247976527, - 7369.50758806164, - 8464.722417201974, - 9170.000000000002, - 12722.007439122684, - 16309.5402904017 - ], - "effective_rank": 6, - "scaled_condition_number": 3.525554312141476, - "weakest_scaled_direction": [ - 0.16366545916520722, - 0.9481472611568502, - 0.02818926809706545, - -0.192825561826524, - 0.03882675679861773, - -0.1864042367113552 - ] - }, - "forward_reverse": { - "translation_m": 0.004882992437392809, - "rotation_deg": 0.09954673132586826 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.869926854192466e-15, - "rotation_deg": 1.3836251688145198e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 17122, - "frame_counter_j": 19343, - "rtk_translation_m": 4.388457127616061, - "rtk_rotation_deg": 94.54259968980386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07007192250787582, - 0.9975096326762966, - -0.008028598510670336, - -1.2440583683201683 - ], - [ - -0.9970233816219525, - -0.07029270645028254, - -0.03167509935295931, - -5.682645076243836 - ], - [ - -0.03216056863887345, - 0.005785165329503689, - 0.9994659722506479, - -0.07624572632481183 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7431, - "backend_objective": 119.47136637315, - "backend_elapsed_sec": 0.5638886000015191, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8846073298429319, - "inlier_rmse_m": 0.4113310986413628, - "target_points": 4783, - "source_points": 4775 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7542124542124542, - "inlier_rmse_m": 0.19621149549955796, - "target_points": 8295, - "source_points": 8190 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6396109485281459, - "inlier_rmse_m": 0.1267967974858376, - "target_points": 11726, - "source_points": 11618 - } - ], - "heldout_symmetric": { - "evaluated": 7916, - "inliers": 5205, - "inlier_ratio": 0.6575290550783224, - "inlier_rmse_m": 0.11893104898070972, - "median_m": 0.14887948027997924, - "p90_m": 1.073593945303037, - "p95_m": 1.5373072246703674 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3345.381686108289, - 4416.5943869102375, - 5473.167451555595, - 7430.999999999997, - 11711.416784157449, - 14062.89609151034 - ], - "effective_rank": 6, - "scaled_condition_number": 4.203674621017558, - "weakest_scaled_direction": [ - 0.04537147228981541, - 0.906445436869757, - 0.05360739896228813, - -0.1801955966618329, - 0.031146530091477324, - -0.37414407233537006 - ] - }, - "forward_reverse": { - "translation_m": 0.005511015274661758, - "rotation_deg": 0.13108161960065734 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.00385052691195e-14, - "rotation_deg": 2.6282359899141385e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 17122, - "frame_counter_j": 20027, - "rtk_translation_m": 8.256548639868363, - "rtk_rotation_deg": 126.4903843444735, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5880718266851332, - 0.807260870105611, - -0.05001414055588199, - -3.2052811503460634 - ], - [ - -0.8068310457168465, - -0.5898328929166088, - -0.03347868129250111, - -9.230993264046077 - ], - [ - -0.0565260146009866, - 0.02066509206264106, - 0.9981872387700471, - -0.1786699423963931 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6341, - "backend_objective": 106.15043237310859, - "backend_elapsed_sec": 0.348938499999349, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8541533205210335, - "inlier_rmse_m": 0.4414708968019263, - "target_points": 4783, - "source_points": 4683 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6876971608832808, - "inlier_rmse_m": 0.21135596057167774, - "target_points": 8295, - "source_points": 8242 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5538958770090846, - "inlier_rmse_m": 0.12938442709714962, - "target_points": 11726, - "source_points": 11448 - } - ], - "heldout_symmetric": { - "evaluated": 7870, - "inliers": 4564, - "inlier_ratio": 0.5799237611181702, - "inlier_rmse_m": 0.12732395079162134, - "median_m": 0.18766252894170404, - "p90_m": 1.5493795923954046, - "p95_m": 2.291725386492558 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2448.9712862000465, - 3263.08581395559, - 3819.9570895743514, - 6341.000000000004, - 12844.049792197304, - 14988.151163172935 - ], - "effective_rank": 6, - "scaled_condition_number": 6.120182481367245, - "weakest_scaled_direction": [ - -0.2874948865744778, - 0.6786235472229305, - 0.028984170787127374, - -0.11536332060823055, - -0.020469918508537906, - -0.6650180267379031 - ] - }, - "forward_reverse": { - "translation_m": 0.02421237470645105, - "rotation_deg": 0.2728497258921342 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5176617391872307e-15, - "rotation_deg": 4.316920030323288e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 18410, - "frame_counter_j": 19343, - "rtk_translation_m": 2.665930009787955, - "rtk_rotation_deg": 43.65775964817948, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7218837689860917, - 0.6920135231904527, - 0.0010525188696827207, - 1.1030580250198543 - ], - [ - -0.6918812720716989, - 0.72177396342792, - -0.018510836663963106, - -3.1399413804876604 - ], - [ - -0.013569430013185713, - 0.012634454443632087, - 0.999828105791205, - 0.007164760168910194 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8208, - "backend_objective": 124.60701246142617, - "backend_elapsed_sec": 0.3604310999944573, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9229319371727749, - "inlier_rmse_m": 0.3648313686822454, - "target_points": 4901, - "source_points": 4775 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8148962148962149, - "inlier_rmse_m": 0.18757406237506444, - "target_points": 8336, - "source_points": 8190 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7064899294198658, - "inlier_rmse_m": 0.12321187538364096, - "target_points": 11782, - "source_points": 11618 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5971, - "inlier_ratio": 0.7379804721295267, - "inlier_rmse_m": 0.11301282071283571, - "median_m": 0.12094748496043199, - "p90_m": 0.6989811812116792, - "p95_m": 1.0604702812460438 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3456.8486722495745, - 6347.3101316107, - 7203.245443672249, - 8207.999999999998, - 11420.611711958716, - 14698.765594200446 - ], - "effective_rank": 6, - "scaled_condition_number": 4.252070885311591, - "weakest_scaled_direction": [ - 0.602374859704518, - -0.6542614935037286, - -0.021602611559935588, - 0.11464362051927753, - 0.0912678577038742, - 0.43260463718319087 - ] - }, - "forward_reverse": { - "translation_m": 0.005342970038949662, - "rotation_deg": 0.023692959917636515 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7465400791133423e-15, - "rotation_deg": 6.493012588035186e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 18410, - "frame_counter_j": 20027, - "rtk_translation_m": 6.670349114267683, - "rtk_rotation_deg": 75.60554430284907, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.24457581929286412, - 0.9692777653481278, - -0.026139667537426, - 2.588451055494132 - ], - [ - -0.9685762788227793, - 0.24296462884392891, - -0.05318064716180277, - -6.927554406315808 - ], - [ - -0.045195804219425, - 0.03832496226318731, - 0.9982427242652382, - -0.028209520252748085 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6853, - "backend_objective": 108.91506975903441, - "backend_elapsed_sec": 0.5781289000005927, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8716634635917148, - "inlier_rmse_m": 0.411445528640454, - "target_points": 4901, - "source_points": 4683 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7257947100218394, - "inlier_rmse_m": 0.20368395020899233, - "target_points": 8336, - "source_points": 8242 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5986198462613557, - "inlier_rmse_m": 0.1260676394800326, - "target_points": 11782, - "source_points": 11448 - } - ], - "heldout_symmetric": { - "evaluated": 8045, - "inliers": 4951, - "inlier_ratio": 0.6154133001864512, - "inlier_rmse_m": 0.11796945645750438, - "median_m": 0.16018460237772153, - "p90_m": 1.201615169279335, - "p95_m": 1.8208920958249983 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2642.5792919139344, - 4224.56472333384, - 4883.469842879197, - 6853.0, - 11965.613217941751, - 14543.590417283354 - ], - "effective_rank": 6, - "scaled_condition_number": 5.503558762374886, - "weakest_scaled_direction": [ - 0.6993597164859718, - -0.3713044557041284, - -0.017202179658215824, - 0.06563948281261295, - 0.09586549112144288, - 0.5993616095931289 - ] - }, - "forward_reverse": { - "translation_m": 0.021862964848253088, - "rotation_deg": 0.18671115674675795 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.004705658634741e-15, - "rotation_deg": 6.408975182712225e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 18410, - "frame_counter_j": 20855, - "rtk_translation_m": 4.0761181240750135, - "rtk_rotation_deg": 118.87493116884215, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.481845965247317, - 0.8755472440209778, - -0.03523477347950109, - 0.5064175499789162 - ], - [ - -0.8745611020363899, - -0.48302477196651467, - -0.04277789699822342, - -4.433847356863259 - ], - [ - -0.0544733382470356, - 0.010202605253875771, - 0.9984631001024816, - -0.04100425329865263 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7372, - "backend_objective": 110.44428550356376, - "backend_elapsed_sec": 0.32562390000384767, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8863244176013805, - "inlier_rmse_m": 0.38230714654387626, - "target_points": 4901, - "source_points": 4636 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7657525898842169, - "inlier_rmse_m": 0.19362136359029944, - "target_points": 8336, - "source_points": 8205 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6513518289450433, - "inlier_rmse_m": 0.12239930778313243, - "target_points": 11782, - "source_points": 11318 - } - ], - "heldout_symmetric": { - "evaluated": 8054, - "inliers": 5387, - "inlier_ratio": 0.6688601936925751, - "inlier_rmse_m": 0.11271893154362743, - "median_m": 0.13054800821370974, - "p90_m": 1.0691481647051413, - "p95_m": 1.4959046853471523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2951.526817144999, - 5514.390024523047, - 6271.642674432268, - 7372.0, - 10626.69030764082, - 13598.399537100719 - ], - "effective_rank": 6, - "scaled_condition_number": 4.6072424136923145, - "weakest_scaled_direction": [ - 0.6457422836239417, - -0.5806335605732496, - -0.011712569621317224, - 0.08419374433280695, - 0.08392669932306666, - 0.48126095805185715 - ] - }, - "forward_reverse": { - "translation_m": 0.017882487871653564, - "rotation_deg": 0.11231417140662198 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.851943855780944e-15, - "rotation_deg": 2.3154812155221307e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 19343, - "frame_counter_j": 20027, - "rtk_translation_m": 4.005228418650323, - "rtk_rotation_deg": 31.947784654669576, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8472147598319634, - 0.5312069888054477, - 0.006803364396951107, - 3.683275626994861 - ], - [ - -0.5304792049934242, - 0.846605127150956, - -0.04302989369331214, - -1.7095999126172408 - ], - [ - -0.02861754343777794, - 0.03284651771439917, - 0.9990506205801706, - 0.07429265803325268 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8100, - "backend_objective": 129.0080715685997, - "backend_elapsed_sec": 0.2264188000044669, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9250480461242793, - "inlier_rmse_m": 0.35279332830932375, - "target_points": 4775, - "source_points": 4683 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8224945401601553, - "inlier_rmse_m": 0.18948617364890966, - "target_points": 8190, - "source_points": 8242 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7075471698113207, - "inlier_rmse_m": 0.1262019113004098, - "target_points": 11618, - "source_points": 11448 - } - ], - "heldout_symmetric": { - "evaluated": 7874, - "inliers": 5724, - "inlier_ratio": 0.7269494538989077, - "inlier_rmse_m": 0.11696827793053062, - "median_m": 0.12613736015050295, - "p90_m": 0.8079919635632702, - "p95_m": 1.3211086339592264 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3533.911775918429, - 5813.483503549238, - 6771.047337223096, - 8100.000000000002, - 11205.749490461723, - 13907.477954038526 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9354343956207307, - "weakest_scaled_direction": [ - 0.9260752616107812, - 0.07179850952889327, - -0.014948891256505179, - -0.005256328091559137, - 0.13919800841853822, - 0.3429320632129062 - ] - }, - "forward_reverse": { - "translation_m": 0.036708381465019306, - "rotation_deg": 0.17149160359500737 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.159339953157541e-16, - "rotation_deg": 1.0263836241945281e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 19343, - "frame_counter_j": 20855, - "rtk_translation_m": 1.4231800329066895, - "rtk_rotation_deg": 75.21717152066267, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.25788577739616375, - 0.9661541695392966, - -0.00640675413990137, - 0.46568710391669416 - ], - [ - -0.9654848162370055, - 0.2574451115716673, - -0.039510557369503076, - -1.3520723587269754 - ], - [ - -0.0365239022090078, - 0.016374834646028374, - 0.9991986135687648, - 0.007121057403838179 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8511, - "backend_objective": 127.38629440814285, - "backend_elapsed_sec": 0.4906935999970301, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9588006902502157, - "inlier_rmse_m": 0.31306125145034036, - "target_points": 4775, - "source_points": 4636 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8864107251675808, - "inlier_rmse_m": 0.19185633221975612, - "target_points": 8190, - "source_points": 8205 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7519879837427107, - "inlier_rmse_m": 0.12234072700733671, - "target_points": 11618, - "source_points": 11318 - } - ], - "heldout_symmetric": { - "evaluated": 7883, - "inliers": 6011, - "inlier_ratio": 0.7625269567423569, - "inlier_rmse_m": 0.11122908154278312, - "median_m": 0.10739349223734442, - "p90_m": 0.5924545986555685, - "p95_m": 1.0801395373349565 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4208.546941654452, - 7335.712282180123, - 8472.15381671556, - 8510.999999999998, - 9231.479723556611, - 12593.57249790488 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9923801902407035, - "weakest_scaled_direction": [ - 0.9662288126271698, - -0.020217082766310124, - 0.010758428849397612, - 0.0005804603679080825, - 0.14164350423125754, - 0.21404249156897143 - ] - }, - "forward_reverse": { - "translation_m": 0.033708002403797385, - "rotation_deg": 0.18898419347187523 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8959313405828643e-15, - "rotation_deg": 1.894477813879012e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 19343, - "frame_counter_j": 21471, - "rtk_translation_m": 0.9824487562406952, - "rtk_rotation_deg": 165.63918634111403, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9667494598157498, - 0.25275035671340645, - -0.03889394717949374, - -2.9860097193412005 - ], - [ - -0.2506706136811903, - -0.9667062247645501, - -0.05141321268085337, - -1.271662755815312 - ], - [ - -0.05059372868894809, - -0.03995412597863977, - 0.9979198076171409, - -0.059312706055856874 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7774, - "backend_objective": 111.84536556220796, - "backend_elapsed_sec": 0.38098400000308175, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9264705882352942, - "inlier_rmse_m": 0.3766420977433844, - "target_points": 4775, - "source_points": 4624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8016810817395541, - "inlier_rmse_m": 0.19115242554787723, - "target_points": 8190, - "source_points": 8209 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6741241762053417, - "inlier_rmse_m": 0.11994626485456243, - "target_points": 11618, - "source_points": 11532 - } - ], - "heldout_symmetric": { - "evaluated": 7947, - "inliers": 5613, - "inlier_ratio": 0.7063042657606644, - "inlier_rmse_m": 0.1109686247290255, - "median_m": 0.1201387273248326, - "p90_m": 0.9245306903052825, - "p95_m": 1.43327964829648 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3540.9787437909217, - 6017.867188169421, - 7221.6611793639595, - 7774.000000000002, - 9080.846624649874, - 11546.64380092787 - ], - "effective_rank": 6, - "scaled_condition_number": 3.260862218157852, - "weakest_scaled_direction": [ - 0.9590567108595855, - -0.0007979045890801895, - 0.036679572127256456, - -0.009053182229993835, - 0.14573433207041514, - 0.23988276728335928 - ] - }, - "forward_reverse": { - "translation_m": 0.0237546710240931, - "rotation_deg": 0.20388046327310663 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5784725430154835e-15, - "rotation_deg": 1.0709076794628853e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 20027, - "frame_counter_j": 20855, - "rtk_translation_m": 2.6253440212817054, - "rtk_rotation_deg": 43.26938686599312, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7315979029790024, - 0.6816787032232391, - -0.008868705013074811, - -2.924649525016458 - ], - [ - -0.6817260465099083, - 0.7315965617178541, - -0.004008539956535947, - -1.4134025244010597 - ], - [ - 0.0037557777750654633, - 0.00897866663243534, - 0.9999526377178108, - -0.05325831242355726 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8610, - "backend_objective": 126.92802651782085, - "backend_elapsed_sec": 0.3291746999966563, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9419758412424504, - "inlier_rmse_m": 0.3261893736534163, - "target_points": 4683, - "source_points": 4636 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.872151127361365, - "inlier_rmse_m": 0.1871746832111053, - "target_points": 8242, - "source_points": 8205 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7607351122106379, - "inlier_rmse_m": 0.12141635421389804, - "target_points": 11448, - "source_points": 11318 - } - ], - "heldout_symmetric": { - "evaluated": 7837, - "inliers": 6155, - "inlier_ratio": 0.785377057547531, - "inlier_rmse_m": 0.11259637754562075, - "median_m": 0.10810704177880562, - "p90_m": 0.542161957499401, - "p95_m": 1.0012616459528307 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3932.0524081964154, - 5474.816478826238, - 7223.890208111019, - 8610.000000000002, - 10330.293590114152, - 12460.58646019685 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1689777161216344, - "weakest_scaled_direction": [ - 0.6516665571458786, - 0.7199091943932867, - 0.027867960207590334, - -0.08727664745254893, - 0.08685350458569348, - -0.20279073566152037 - ] - }, - "forward_reverse": { - "translation_m": 0.008388924730327863, - "rotation_deg": 0.09824473511740778 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.6131920609444395e-15, - "rotation_deg": 5.887297453606251e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 20027, - "frame_counter_j": 21471, - "rtk_translation_m": 4.30404511575867, - "rtk_rotation_deg": 133.69140168644446, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6847606497059656, - 0.7280107880921869, - -0.033213627258352266, - -5.884098724148151 - ], - [ - -0.7274656553714964, - -0.6855501314987452, - -0.02854360623629836, - -3.1809510766879487 - ], - [ - -0.04354965980559433, - 0.004616234769442908, - 0.9990405985280926, - -0.15107722772536858 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7278, - "backend_objective": 110.71833404889564, - "backend_elapsed_sec": 0.24744400000054156, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8682958477508651, - "inlier_rmse_m": 0.39227302044702694, - "target_points": 4683, - "source_points": 4624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7488122792057498, - "inlier_rmse_m": 0.19495027577279175, - "target_points": 8242, - "source_points": 8209 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6311134235171696, - "inlier_rmse_m": 0.12333994362733836, - "target_points": 11448, - "source_points": 11532 - } - ], - "heldout_symmetric": { - "evaluated": 7901, - "inliers": 5392, - "inlier_ratio": 0.682445260093659, - "inlier_rmse_m": 0.11585305930039552, - "median_m": 0.13298788151345559, - "p90_m": 1.0603927302746128, - "p95_m": 1.8580324981022545 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3163.0109429734594, - 4004.988001182087, - 5073.207748897091, - 7277.999999999998, - 12015.523061723188, - 14106.413101397686 - ], - "effective_rank": 6, - "scaled_condition_number": 4.459805342354154, - "weakest_scaled_direction": [ - 0.8081218693519261, - 0.5508567469351144, - 0.06089520017051001, - -0.08496221686466411, - 0.13755614053614224, - -0.11682205756469173 - ] - }, - "forward_reverse": { - "translation_m": 0.03262070035564156, - "rotation_deg": 0.26820774135203534 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0778315928076987e-15, - "rotation_deg": 1.2401385664995157e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 20027, - "frame_counter_j": 22301, - "rtk_translation_m": 6.580252552934289, - "rtk_rotation_deg": 159.52196102005493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9375544695197546, - -0.34364798157040144, - -0.053830116534508685, - -7.833373943547041 - ], - [ - 0.34476101079678306, - -0.9386048495859853, - -0.01267997508087462, - -3.4797035024430962 - ], - [ - -0.04616776059016315, - -0.030446692698218973, - 0.9984695973267435, - -0.2273979584181676 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6728, - "backend_objective": 106.80666993133968, - "backend_elapsed_sec": 0.4529060999993817, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7898640296662547, - "inlier_rmse_m": 0.4124565400107671, - "target_points": 4683, - "source_points": 4854 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6766765578635014, - "inlier_rmse_m": 0.19941539599501268, - "target_points": 8242, - "source_points": 8425 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5740124562750618, - "inlier_rmse_m": 0.12599583699886022, - "target_points": 11448, - "source_points": 11721 - } - ], - "heldout_symmetric": { - "evaluated": 7886, - "inliers": 4882, - "inlier_ratio": 0.6190717727618564, - "inlier_rmse_m": 0.1225437625254746, - "median_m": 0.16285026037192588, - "p90_m": 1.567164112976744, - "p95_m": 2.3085569997293187 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2944.2379727379357, - 3262.4481868625458, - 4235.56733045849, - 6728.0, - 11923.433141178073, - 13981.19906341104 - ], - "effective_rank": 6, - "scaled_condition_number": 4.748664745468758, - "weakest_scaled_direction": [ - 0.28323210760640866, - 0.7306368863211128, - 0.06480780497377935, - -0.12188074600419833, - 0.10023391304794751, - -0.5973671470803007 - ] - }, - "forward_reverse": { - "translation_m": 0.020450511219618477, - "rotation_deg": 0.11876511292532045 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.395356834685837e-15, - "rotation_deg": 4.6937859844999334e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 20855, - "frame_counter_j": 21471, - "rtk_translation_m": 2.0155105379126432, - "rtk_rotation_deg": 90.4220148204513, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.005363690155856088, - 0.9999849183563546, - 0.0011806302327514791, - -0.9617512396691585 - ], - [ - -0.9994709723876247, - -0.005323052499366476, - -0.03208489467997208, - -3.312903023792918 - ], - [ - -0.03207812623031286, - -0.0013520990805049936, - 0.9994844499268755, - -0.0367702782503112 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8361, - "backend_objective": 114.36437467794461, - "backend_elapsed_sec": 0.33836219999648165, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.941825259515571, - "inlier_rmse_m": 0.35853719846093035, - "target_points": 4636, - "source_points": 4624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8406626872944329, - "inlier_rmse_m": 0.18625179330985278, - "target_points": 8205, - "source_points": 8209 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7250260145681582, - "inlier_rmse_m": 0.11695431998142888, - "target_points": 11318, - "source_points": 11532 - } - ], - "heldout_symmetric": { - "evaluated": 7910, - "inliers": 6061, - "inlier_ratio": 0.7662452591656131, - "inlier_rmse_m": 0.10751986617832841, - "median_m": 0.10116145904399934, - "p90_m": 0.6443335547476615, - "p95_m": 1.1104936567026016 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3669.8804555877064, - 4999.851831425926, - 6868.456269097223, - 8361.0, - 10017.110412921093, - 11770.616577257417 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2073569479179214, - "weakest_scaled_direction": [ - 0.3324100365975593, - 0.931784248497209, - 0.03954614742761439, - -0.1288241341485682, - 0.044524675245431605, - 0.033759143953819494 - ] - }, - "forward_reverse": { - "translation_m": 0.020801978066425954, - "rotation_deg": 0.11499836231449187 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3258857712255147e-15, - "rotation_deg": 3.39796436837418e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 20855, - "frame_counter_j": 22301, - "rtk_translation_m": 4.344602404326578, - "rtk_rotation_deg": 157.20865211395216, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9211380419809985, - 0.38839871558081185, - -0.025517549854731952, - -2.1841545043389186 - ], - [ - -0.3875454391797973, - -0.9212677492070149, - -0.03277601015953865, - -4.861572988036573 - ], - [ - -0.03623865596777514, - -0.020302019757062275, - 0.999136921451426, - -0.07340340775024909 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7664, - "backend_objective": 112.70401986803651, - "backend_elapsed_sec": 0.31347890000324696, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8498145859085291, - "inlier_rmse_m": 0.387686531802429, - "target_points": 4636, - "source_points": 4854 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7541839762611275, - "inlier_rmse_m": 0.1880243121959097, - "target_points": 8205, - "source_points": 8425 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.653869123794898, - "inlier_rmse_m": 0.12126681052785941, - "target_points": 11318, - "source_points": 11721 - } - ], - "heldout_symmetric": { - "evaluated": 7895, - "inliers": 5567, - "inlier_ratio": 0.7051298290056998, - "inlier_rmse_m": 0.11713046861462412, - "median_m": 0.1301772967657091, - "p90_m": 1.0895494240119423, - "p95_m": 1.7020252334945716 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3408.6202101993836, - 4966.592234366869, - 6090.1291197882065, - 7663.999999999998, - 11506.227175234615, - 13778.800543548294 - ], - "effective_rank": 6, - "scaled_condition_number": 4.0423396253765445, - "weakest_scaled_direction": [ - 0.37364758000210885, - 0.9097035751194301, - 0.05050273867222714, - -0.15483706013799015, - 0.06076091341251229, - 0.05108777710178346 - ] - }, - "forward_reverse": { - "translation_m": 0.02866879831073192, - "rotation_deg": 0.14020373652670878 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1868857395626282e-15, - "rotation_deg": 2.9937034517109715e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 20855, - "frame_counter_j": 22832, - "rtk_translation_m": 4.194437499675352, - "rtk_rotation_deg": 171.65485957819877, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.988553177774717, - -0.14821714741539485, - -0.028183185120709088, - -1.6964712100693118 - ], - [ - 0.14897417923373385, - -0.9884730917029156, - -0.0269748197568689, - -3.927746033995513 - ], - [ - -0.023860189293895356, - -0.030864610662102963, - 0.9992387438322916, - -0.06316233111857894 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7891, - "backend_objective": 113.90289549445808, - "backend_elapsed_sec": 0.5935157999992953, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8870863075924724, - "inlier_rmse_m": 0.38192903714442533, - "target_points": 4636, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7820107108081792, - "inlier_rmse_m": 0.19258958402327248, - "target_points": 8205, - "source_points": 8216 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6803172687300629, - "inlier_rmse_m": 0.12014379901318356, - "target_points": 11318, - "source_points": 11599 - } - ], - "heldout_symmetric": { - "evaluated": 7906, - "inliers": 5717, - "inlier_ratio": 0.7231216797369087, - "inlier_rmse_m": 0.11332956637109663, - "median_m": 0.1196667287779433, - "p90_m": 0.8651839293190786, - "p95_m": 1.4962213505958402 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3511.907423331816, - 4918.057858463517, - 6360.7828136427015, - 7890.999999999998, - 10503.398491020842, - 12550.551873484046 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5737137574022637, - "weakest_scaled_direction": [ - 0.36135381633906977, - 0.9170637677453837, - 0.04851774566449471, - -0.14790635519695247, - 0.056622967555996606, - 0.031321610733986635 - ] - }, - "forward_reverse": { - "translation_m": 0.0391123663878616, - "rotation_deg": 0.31745415833557195 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.5188334428407404e-15, - "rotation_deg": 8.075573290902457e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 21471, - "frame_counter_j": 22301, - "rtk_translation_m": 2.340922525153354, - "rtk_rotation_deg": 66.78663729350096, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3932897621157184, - 0.9194145654815569, - -0.0001406958459414142, - 1.5630561499147755 - ], - [ - -0.9190433557123507, - 0.39312661570169805, - -0.028474099597912323, - -1.2152009804602824 - ], - [ - -0.02612419062753488, - 0.011327877439710993, - 0.9995945207216609, - 0.008744935201204423 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8827, - "backend_objective": 111.88478301759078, - "backend_elapsed_sec": 0.2721100999988266, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9398434281005357, - "inlier_rmse_m": 0.33776645013004153, - "target_points": 4624, - "source_points": 4854 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8554302670623145, - "inlier_rmse_m": 0.18062532839370846, - "target_points": 8209, - "source_points": 8425 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7530927395273441, - "inlier_rmse_m": 0.11258458950795346, - "target_points": 11532, - "source_points": 11721 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 6484, - "inlier_ratio": 0.8146752104535746, - "inlier_rmse_m": 0.1067005622933313, - "median_m": 0.09593666478113926, - "p90_m": 0.44717189860492046, - "p95_m": 0.784338341549657 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4089.2452236432623, - 6467.476022252066, - 8421.108365851454, - 8827.0, - 9579.714287643548, - 11676.91249398543 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8555177924942416, - "weakest_scaled_direction": [ - 0.8714385987222086, - -0.46073467142396707, - -0.008303791084562669, - 0.06836139466737667, - 0.12776464964998097, - 0.08516039148275074 - ] - }, - "forward_reverse": { - "translation_m": 0.015155094735859666, - "rotation_deg": 0.09937091691588736 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.446597313700017e-15, - "rotation_deg": 1.785804185076351e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 21471, - "frame_counter_j": 22832, - "rtk_translation_m": 2.187150933555911, - "rtk_rotation_deg": 97.92312560134954, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.14286922462627166, - 0.9897293554936732, - -0.004918081817645965, - 0.6164052084983502 - ], - [ - -0.9893293165257449, - -0.14295135807847528, - -0.028149825687226054, - -0.7341284052309955 - ], - [ - -0.028563755309651058, - 0.000843858753970683, - 0.9995916165039672, - 0.009486078584492744 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9320, - "backend_objective": 109.31219743642447, - "backend_elapsed_sec": 0.2587424000012106, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9612805537529743, - "inlier_rmse_m": 0.28716179616053045, - "target_points": 4624, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9084712755598832, - "inlier_rmse_m": 0.17347074375621, - "target_points": 8209, - "source_points": 8216 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8035175446159152, - "inlier_rmse_m": 0.10829947621744337, - "target_points": 11532, - "source_points": 11599 - } - ], - "heldout_symmetric": { - "evaluated": 7970, - "inliers": 6759, - "inlier_ratio": 0.8480552070263488, - "inlier_rmse_m": 0.10282262567757873, - "median_m": 0.08697234076040439, - "p90_m": 0.3517146451030987, - "p95_m": 0.5688866395295826 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4572.403338635837, - 7151.420707010712, - 9035.963296048772, - 9320.0, - 10073.011606177983, - 12806.610374477745 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8008487935140383, - "weakest_scaled_direction": [ - 0.9017970792717486, - -0.369447123081301, - 0.0015585469741023936, - 0.058493789204651536, - 0.14346333041965686, - 0.16206533079164476 - ] - }, - "forward_reverse": { - "translation_m": 0.020178532297188766, - "rotation_deg": 0.14259764688967286 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4708138479614427e-15, - "rotation_deg": 1.3898673429711823e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 21471, - "frame_counter_j": 23867, - "rtk_translation_m": 6.688406442287195, - "rtk_rotation_deg": 171.26720999836604, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.987676411459886, - -0.14646470902791653, - -0.05516697612777326, - 2.7994573385486174 - ], - [ - 0.1491267828317508, - -0.9876677116169565, - -0.04768326825606914, - -3.8160527273321296 - ], - [ - -0.04750272505831976, - -0.0553225129463245, - 0.9973379119803564, - -0.01680389599882286 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7008, - "backend_objective": 101.67006038206819, - "backend_elapsed_sec": 0.6255956000022707, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8509240246406571, - "inlier_rmse_m": 0.4171858670459701, - "target_points": 4624, - "source_points": 4870 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7164179104477612, - "inlier_rmse_m": 0.19517747281322123, - "target_points": 8209, - "source_points": 8308 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6012354152367879, - "inlier_rmse_m": 0.1204479725674731, - "target_points": 11532, - "source_points": 11656 - } - ], - "heldout_symmetric": { - "evaluated": 7957, - "inliers": 5185, - "inlier_ratio": 0.6516274978006786, - "inlier_rmse_m": 0.11571138405667894, - "median_m": 0.14148786304481872, - "p90_m": 1.0524588223436435, - "p95_m": 1.484755350031208 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3273.0939242301556, - 4794.206357661502, - 5970.750712474303, - 7007.999999999998, - 9405.535627177738, - 11489.107265834351 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5101673009694134, - "weakest_scaled_direction": [ - 0.7699051397356107, - -0.608094222389781, - -0.020033858905888106, - 0.10948909816309121, - 0.135947842818848, - 0.0812185841943252 - ] - }, - "forward_reverse": { - "translation_m": 0.012932261164889271, - "rotation_deg": 0.1340627397278959 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5124929012273932e-15, - "rotation_deg": 9.086683793082136e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 22301, - "frame_counter_j": 22832, - "rtk_translation_m": 0.6349061963265976, - "rtk_rotation_deg": 31.136488307848563, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8538006100022718, - 0.5205972917009308, - -0.0017257558935776845, - -0.8104695563319614 - ], - [ - -0.5205997668211398, - 0.8537993199533249, - -0.001613701649559284, - -0.6781561711621104 - ], - [ - 0.0006333604999681808, - 0.00227620756854214, - 0.9999972088628959, - -0.005846940636488176 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9709, - "backend_objective": 136.12245459389771, - "backend_elapsed_sec": 0.2870318999994197, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9772874756651525, - "inlier_rmse_m": 0.27944485028786253, - "target_points": 4854, - "source_points": 4623 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9318403115871471, - "inlier_rmse_m": 0.16940808043181338, - "target_points": 8425, - "source_points": 8216 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8370549185274593, - "inlier_rmse_m": 0.11840707021477218, - "target_points": 11721, - "source_points": 11599 - } - ], - "heldout_symmetric": { - "evaluated": 7955, - "inliers": 6895, - "inlier_ratio": 0.8667504714016342, - "inlier_rmse_m": 0.10966038141955464, - "median_m": 0.0893188040469041, - "p90_m": 0.2903569322194293, - "p95_m": 0.46816151266292544 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4896.62337183985, - 8672.178557718431, - 9708.999999999998, - 9756.308214180548, - 10547.631233935701, - 14345.771683833664 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9297274048756186, - "weakest_scaled_direction": [ - 0.7455267577431389, - 0.6456810626509821, - 0.013331627634141792, - -0.10112350189563181, - 0.11553339842759627, - 0.05944878249098156 - ] - }, - "forward_reverse": { - "translation_m": 0.0016799531047772863, - "rotation_deg": 0.021489450960699312 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3226229184323991e-15, - "rotation_deg": 1.6412429519641334e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 22301, - "frame_counter_j": 23867, - "rtk_translation_m": 5.008419104260455, - "rtk_rotation_deg": 121.94615270813352, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5242036597752764, - 0.8515838106578241, - -0.003941637186061626, - 2.8839167523370666 - ], - [ - -0.85010828078287, - -0.5235573581789366, - -0.056600385520646355, - 0.12012842772886964 - ], - [ - -0.0502636451384082, - -0.026319310822901683, - 0.9983891324805214, - 0.03401953456073927 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7877, - "backend_objective": 116.87654244348538, - "backend_elapsed_sec": 0.34970289999910165, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9147843942505134, - "inlier_rmse_m": 0.37946743900113283, - "target_points": 4854, - "source_points": 4870 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7977852672123255, - "inlier_rmse_m": 0.19079194317110526, - "target_points": 8425, - "source_points": 8308 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6757892930679479, - "inlier_rmse_m": 0.12181008744355659, - "target_points": 11721, - "source_points": 11656 - } - ], - "heldout_symmetric": { - "evaluated": 7942, - "inliers": 5595, - "inlier_ratio": 0.7044824981113069, - "inlier_rmse_m": 0.11528623479803272, - "median_m": 0.12474195810659136, - "p90_m": 0.7515249892952646, - "p95_m": 1.1633229319793972 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3971.952321625834, - 5928.668800381965, - 7382.245810171075, - 7877.000000000002, - 9372.969552315064, - 11883.212813668999 - ], - "effective_rank": 6, - "scaled_condition_number": 2.991781333569699, - "weakest_scaled_direction": [ - 0.876175692786285, - 0.4405508944769608, - -0.0015687817048271244, - -0.08374043960762176, - 0.16675245635467315, - 0.05839315665376423 - ] - }, - "forward_reverse": { - "translation_m": 0.011526585390891731, - "rotation_deg": 0.12425176309998268 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.330861382854123e-16, - "rotation_deg": 2.366805904648165e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 22301, - "frame_counter_j": 24538, - "rtk_translation_m": 2.224643201350574, - "rtk_rotation_deg": 145.73622267800252, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8295394870970153, - 0.5581902292580275, - -0.016967831555502966, - -1.871694340457159 - ], - [ - -0.5566223920903675, - -0.8289006633149197, - -0.05563454843605863, - -2.9298304691995414 - ], - [ - -0.04511930817756259, - -0.03670637978551166, - 0.9983070117517056, - -0.10255531185451625 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7924, - "backend_objective": 110.23396356949974, - "backend_elapsed_sec": 0.5270935000007739, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8935166187935987, - "inlier_rmse_m": 0.38617977070415527, - "target_points": 4854, - "source_points": 4874 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7857909166766003, - "inlier_rmse_m": 0.18875973553495173, - "target_points": 8425, - "source_points": 8389 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6781343602909713, - "inlier_rmse_m": 0.1179466141189207, - "target_points": 11721, - "source_points": 11685 - } - ], - "heldout_symmetric": { - "evaluated": 7917, - "inliers": 5650, - "inlier_ratio": 0.713654161930024, - "inlier_rmse_m": 0.11136018082941974, - "median_m": 0.11711516561068201, - "p90_m": 0.9612581391276749, - "p95_m": 1.5297154618556155 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3697.433565465047, - 4702.214814541274, - 6404.145352882606, - 7923.999999999998, - 10071.767810174415, - 12055.529027254397 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2605126809731075, - "weakest_scaled_direction": [ - 0.7735199038297194, - 0.6068968785648327, - 0.048447272216841225, - -0.1062463457328997, - 0.13149092421978464, - 0.04917163662624739 - ] - }, - "forward_reverse": { - "translation_m": 0.0026952303885011083, - "rotation_deg": 0.026655596724504224 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3944312166872456e-15, - "rotation_deg": 3.140190742515031e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 22832, - "frame_counter_j": 23867, - "rtk_translation_m": 5.622863551235285, - "rtk_rotation_deg": 90.80966440028486, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.004988939693641744, - 0.999657085356811, - 0.02570646176857698, - 2.7386248716996597 - ], - [ - -0.9989723389787761, - -0.0038241587791274807, - -0.045162393259278705, - 2.594890346853918 - ], - [ - -0.04504860082185606, - -0.025905356696214913, - 0.9986488552331266, - 0.044227197646508905 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7766, - "backend_objective": 108.70748712340516, - "backend_elapsed_sec": 0.2266098999971291, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9030800821355236, - "inlier_rmse_m": 0.38295384406441424, - "target_points": 4623, - "source_points": 4870 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7845450168512277, - "inlier_rmse_m": 0.19049268501906316, - "target_points": 8216, - "source_points": 8308 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6662663006177076, - "inlier_rmse_m": 0.11831261004658235, - "target_points": 11599, - "source_points": 11656 - } - ], - "heldout_symmetric": { - "evaluated": 7953, - "inliers": 5614, - "inlier_ratio": 0.7058971457311706, - "inlier_rmse_m": 0.1123767383226778, - "median_m": 0.1225085417380958, - "p90_m": 0.778740155143676, - "p95_m": 1.156343730408758 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3670.627434434386, - 5537.529686485229, - 6953.599558596386, - 7765.999999999998, - 9663.609267964628, - 11884.04055277451 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2376046779603893, - "weakest_scaled_direction": [ - 0.5533462160170404, - 0.8128560408026986, - -0.010587439310321793, - -0.14940295228081374, - 0.10191243910023749, - 0.015922967231396547 - ] - }, - "forward_reverse": { - "translation_m": 0.004853942846193662, - "rotation_deg": 0.04151426276015074 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.390480750425384e-16, - "rotation_deg": 2.541450194444837e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 22832, - "frame_counter_j": 24538, - "rtk_translation_m": 2.458639091699311, - "rtk_rotation_deg": 114.59973437015381, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.41861393881588443, - 0.9081040319979841, - 0.010461228324386307, - 0.27043057663194997 - ], - [ - -0.9073035545966536, - -0.4176880442091319, - -0.04834208871189512, - -2.4747399529576115 - ], - [ - -0.03953011567563815, - -0.02972818181043622, - 0.9987760535580115, - -0.04562196596502673 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8414, - "backend_objective": 125.7611556421393, - "backend_elapsed_sec": 0.2997555999972974, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9179318834632745, - "inlier_rmse_m": 0.35850636925063306, - "target_points": 4623, - "source_points": 4874 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8253665514364048, - "inlier_rmse_m": 0.18361573440482076, - "target_points": 8216, - "source_points": 8389 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7200684638425332, - "inlier_rmse_m": 0.12225651334842466, - "target_points": 11599, - "source_points": 11685 - } - ], - "heldout_symmetric": { - "evaluated": 7928, - "inliers": 5997, - "inlier_ratio": 0.7564328960645812, - "inlier_rmse_m": 0.11469589052522192, - "median_m": 0.11479814096444782, - "p90_m": 0.7577252702414484, - "p95_m": 1.2191899836074707 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4189.086558889987, - 6711.776735810124, - 7923.244943403709, - 8414.0, - 10449.224582762705, - 13426.571749619565 - ], - "effective_rank": 6, - "scaled_condition_number": 3.205131133212321, - "weakest_scaled_direction": [ - 0.1974371586142207, - 0.9627569210896274, - 0.036259697170080527, - -0.1697496004622338, - 0.03277844459133126, - 0.05397740607498236 - ] - }, - "forward_reverse": { - "translation_m": 0.012664149059349924, - "rotation_deg": 0.06847473063899887 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2039045623040506e-15, - "rotation_deg": 3.042077816899448e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 22832, - "frame_counter_j": 25032, - "rtk_translation_m": 2.614522132166758, - "rtk_rotation_deg": 143.98503586800658, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8030547182750832, - 0.5957957140278111, - -0.01142744950626229, - -0.9691053041441982 - ], - [ - -0.5949245016668079, - -0.8026853382554909, - -0.04196528405918694, - -3.011745774634933 - ], - [ - -0.03417538255275485, - -0.026901949664648497, - 0.9990537164395189, - -0.04291852837756955 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8334, - "backend_objective": 113.83987312249604, - "backend_elapsed_sec": 0.2999768000008771, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9272185571398169, - "inlier_rmse_m": 0.3456597203393336, - "target_points": 4623, - "source_points": 4699 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8427798682972719, - "inlier_rmse_m": 0.17707964849592986, - "target_points": 8216, - "source_points": 8504 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7355692850838482, - "inlier_rmse_m": 0.1168746850234882, - "target_points": 11599, - "source_points": 11330 - } - ], - "heldout_symmetric": { - "evaluated": 7916, - "inliers": 6091, - "inlier_ratio": 0.7694542698332492, - "inlier_rmse_m": 0.10812761282109745, - "median_m": 0.10220407876302295, - "p90_m": 0.683995129079065, - "p95_m": 1.167410571768365 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3872.2254286701086, - 6745.465226886375, - 7741.83692965934, - 8333.999999999996, - 10955.762957814793, - 13799.159423012303 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5636250205999853, - "weakest_scaled_direction": [ - -0.22637369226996668, - -0.9605771216120338, - -0.03794741785141644, - 0.15124619321873006, - -0.03643685049991743, - 0.02008689434686909 - ] - }, - "forward_reverse": { - "translation_m": 0.029100131201629794, - "rotation_deg": 0.2714584305620497 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4449569726155179e-15, - "rotation_deg": 5.787484066501096e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 23867, - "frame_counter_j": 24538, - "rtk_translation_m": 5.5254251571777075, - "rtk_rotation_deg": 23.790069969868927, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9102669470477415, - 0.41399019085540983, - 0.005119276109588648, - 5.082535151863682 - ], - [ - -0.4139213669634026, - 0.9102488639259306, - -0.010775327962597517, - -2.450941782249316 - ], - [ - -0.009120695342641606, - 0.0076894471228077755, - 0.9999288401278423, - 0.0728133546865607 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7664, - "backend_objective": 114.00119031424686, - "backend_elapsed_sec": 0.31752539999433793, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.913007796471071, - "inlier_rmse_m": 0.3899266077247128, - "target_points": 4870, - "source_points": 4874 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7838836571701037, - "inlier_rmse_m": 0.19773400674012226, - "target_points": 8308, - "source_points": 8389 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6558836114676936, - "inlier_rmse_m": 0.1219626760614398, - "target_points": 11656, - "source_points": 11685 - } - ], - "heldout_symmetric": { - "evaluated": 7915, - "inliers": 5344, - "inlier_ratio": 0.6751737207833228, - "inlier_rmse_m": 0.11779777341629802, - "median_m": 0.13811527247949207, - "p90_m": 0.8983474010732945, - "p95_m": 1.294060740413257 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3080.419355297311, - 4550.440172028404, - 5458.852404979376, - 7663.999999999998, - 11862.338381978307, - 14098.747717735216 - ], - "effective_rank": 6, - "scaled_condition_number": 4.576892329120707, - "weakest_scaled_direction": [ - 0.8716847861036288, - -0.20346051364257467, - -0.03342156256278399, - 0.04911862030784595, - 0.14168922539984408, - 0.4185259570973811 - ] - }, - "forward_reverse": { - "translation_m": 0.02178556321929983, - "rotation_deg": 0.16690946122682282 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2782640434660324e-15, - "rotation_deg": 1.3431514153653538e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 23867, - "frame_counter_j": 25032, - "rtk_translation_m": 6.682895390289165, - "rtk_rotation_deg": 53.17537146772172, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5998252993646357, - 0.8001289338203266, - -0.0018164541483733426, - 5.6315435120729225 - ], - [ - -0.7996471983932171, - 0.5993821377326837, - -0.03613047285708746, - -3.6877598404710397 - ], - [ - -0.027820286555020203, - 0.023124494168444837, - 0.999345430482098, - 0.07990488251938149 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7256, - "backend_objective": 117.91135637772743, - "backend_elapsed_sec": 0.28771730000153184, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8965737390934241, - "inlier_rmse_m": 0.4043533396772098, - "target_points": 4870, - "source_points": 4699 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7710489181561618, - "inlier_rmse_m": 0.1996983112444392, - "target_points": 8308, - "source_points": 8504 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6404236540158871, - "inlier_rmse_m": 0.12747622104487114, - "target_points": 11656, - "source_points": 11330 - } - ], - "heldout_symmetric": { - "evaluated": 7903, - "inliers": 5130, - "inlier_ratio": 0.6491205871188156, - "inlier_rmse_m": 0.12153627244194264, - "median_m": 0.15220954302102804, - "p90_m": 1.166492156128578, - "p95_m": 1.6464571932567522 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2799.6007087090325, - 4111.654902815169, - 4816.162509369737, - 7256.000000000002, - 12358.626538062888, - 14605.695425644348 - ], - "effective_rank": 6, - "scaled_condition_number": 5.217063769204219, - "weakest_scaled_direction": [ - 0.8402497943674436, - -0.044924054888422715, - -0.02325626534648812, - 0.021244911968829428, - 0.12581778329123822, - 0.5245376989341185 - ] - }, - "forward_reverse": { - "translation_m": 0.03128065038149053, - "rotation_deg": 0.11076032475862632 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2121008542807775e-15, - "rotation_deg": 1.6961176944430868e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 23867, - "frame_counter_j": 25658, - "rtk_translation_m": 11.27338119162288, - "rtk_rotation_deg": 23.882243944837096, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9103449697643552, - 0.4138489116552778, - -0.0010556261070418095, - 10.307871150160208 - ], - [ - -0.41341106519065984, - 0.9092584382338553, - -0.04837751211518877, - -4.842233369866662 - ], - [ - -0.01906114379201317, - 0.044476632317131434, - 0.9988285648573868, - 0.14291257612359615 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6049, - "backend_objective": 104.75708112565634, - "backend_elapsed_sec": 0.2905689999970491, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8372349823321554, - "inlier_rmse_m": 0.4468275550454744, - "target_points": 4870, - "source_points": 4528 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6821208384710234, - "inlier_rmse_m": 0.2158328200154427, - "target_points": 8308, - "source_points": 8110 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5357838795394154, - "inlier_rmse_m": 0.13159818582999966, - "target_points": 11656, - "source_points": 11290 - } - ], - "heldout_symmetric": { - "evaluated": 7921, - "inliers": 4394, - "inlier_ratio": 0.5547279383916173, - "inlier_rmse_m": 0.13098667045941628, - "median_m": 0.205878137409519, - "p90_m": 1.615563886386715, - "p95_m": 2.275502992502955 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1844.1721812177354, - 2695.4142054271897, - 3106.568013045264, - 6049.0, - 13932.697986660478, - 15746.423354481383 - ], - "effective_rank": 6, - "scaled_condition_number": 8.538477868201968, - "weakest_scaled_direction": [ - 0.695420150474029, - 0.15161542456836333, - -0.022768806371885685, - 0.0007817896544881731, - 0.10075404380644053, - 0.6947900188298762 - ] - }, - "forward_reverse": { - "translation_m": 0.007811024872033181, - "rotation_deg": 0.25693805699014277 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.260934972139191e-15, - "rotation_deg": 1.781926206974061e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 24538, - "frame_counter_j": 25032, - "rtk_translation_m": 1.1998189814142899, - "rtk_rotation_deg": 29.3853014978528, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8773211442337403, - 0.4798985861252502, - 0.002226413121687831, - 1.0188505456830872 - ], - [ - -0.47968782850408115, - 0.8770561277162716, - -0.025925586210897026, - -0.8961343743799698 - ], - [ - -0.014394341438281983, - 0.02167708168377922, - 0.9996613962058514, - 0.02465825556754161 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9060, - "backend_objective": 138.04866029376646, - "backend_elapsed_sec": 0.3623393000016222, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9663758246435412, - "inlier_rmse_m": 0.29062356620214636, - "target_points": 4874, - "source_points": 4699 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9118062088428974, - "inlier_rmse_m": 0.1800056919897175, - "target_points": 8389, - "source_points": 8504 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7996469549867609, - "inlier_rmse_m": 0.12343888760363124, - "target_points": 11685, - "source_points": 11330 - } - ], - "heldout_symmetric": { - "evaluated": 7878, - "inliers": 6376, - "inlier_ratio": 0.8093424727088093, - "inlier_rmse_m": 0.11457686827315132, - "median_m": 0.1082418355287961, - "p90_m": 0.44093055962133587, - "p95_m": 0.6903270330844613 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4690.807493813861, - 7698.907146240926, - 9060.0, - 9120.581092513577, - 9538.149926414559, - 12935.293731159942 - ], - "effective_rank": 6, - "scaled_condition_number": 2.757583581977887, - "weakest_scaled_direction": [ - 0.9339210387739588, - 0.294357820284625, - 0.007920772730544378, - -0.04666316990349926, - 0.14443564207028253, - 0.13432468948896828 - ] - }, - "forward_reverse": { - "translation_m": 0.011632920497220726, - "rotation_deg": 0.07792616982135933 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.623746175455571e-15, - "rotation_deg": 5.310944878659636e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 24538, - "frame_counter_j": 25658, - "rtk_translation_m": 5.755712819539279, - "rtk_rotation_deg": 0.09217397496817598, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999671240878436, - -5.4960898070024795e-05, - 0.008108496949906546, - 5.749261105631714 - ], - [ - 0.00035730367033315216, - 0.999304406533746, - -0.037290419900093616, - -0.013120088994288657 - ], - [ - -0.008100807217439936, - 0.03729209113924579, - 0.9992715731275899, - 0.1266788552341106 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7672, - "backend_objective": 118.09526444844658, - "backend_elapsed_sec": 0.4078603999951156, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9045936395759717, - "inlier_rmse_m": 0.36885839518576286, - "target_points": 4874, - "source_points": 4528 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8053020961775585, - "inlier_rmse_m": 0.19596991049230963, - "target_points": 8389, - "source_points": 8110 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6795394154118689, - "inlier_rmse_m": 0.1240686179348452, - "target_points": 11685, - "source_points": 11290 - } - ], - "heldout_symmetric": { - "evaluated": 7896, - "inliers": 5678, - "inlier_ratio": 0.7190982776089159, - "inlier_rmse_m": 0.1179079898277715, - "median_m": 0.12952000596638963, - "p90_m": 0.841600934371909, - "p95_m": 1.4187308212361949 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3222.6637217791585, - 4764.034943136824, - 5737.612880105094, - 7672.000000000003, - 11212.188294558266, - 13504.101389446518 - ], - "effective_rank": 6, - "scaled_condition_number": 4.190353867263325, - "weakest_scaled_direction": [ - 0.8002954099437516, - 0.4387628423676525, - -0.008994642443459376, - -0.05571805730204254, - 0.10961618415675022, - 0.389632277473434 - ] - }, - "forward_reverse": { - "translation_m": 0.010102013331328315, - "rotation_deg": 0.05295397679545269 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0404639454301458e-15, - "rotation_deg": 1.7837376786736782e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 24538, - "frame_counter_j": 26188, - "rtk_translation_m": 7.3497160995478215, - "rtk_rotation_deg": 44.7412737155501, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7078710772350626, - -0.706273733249871, - -0.009795495666971648, - 6.915868011183194 - ], - [ - 0.7062307323125239, - 0.7079376140697297, - -0.007904892319175516, - 1.5906518157804748 - ], - [ - 0.01251761764030858, - -0.0013222354368475956, - 0.9999207773329165, - 0.18510221626216425 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7227, - "backend_objective": 116.42331822105132, - "backend_elapsed_sec": 0.6779447000008076, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9096989966555183, - "inlier_rmse_m": 0.4084799985221956, - "target_points": 4874, - "source_points": 4784 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7661074641380987, - "inlier_rmse_m": 0.1994596794048517, - "target_points": 8389, - "source_points": 8226 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6339473684210526, - "inlier_rmse_m": 0.1269231842625366, - "target_points": 11685, - "source_points": 11400 - } - ], - "heldout_symmetric": { - "evaluated": 7765, - "inliers": 5307, - "inlier_ratio": 0.683451384417257, - "inlier_rmse_m": 0.12293657670032715, - "median_m": 0.14252274870631063, - "p90_m": 0.8379561088577904, - "p95_m": 1.24439175723231 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3118.982070985261, - 4258.928069899846, - 5143.663826952046, - 7227.000000000002, - 11973.655515864084, - 14296.06865659251 - ], - "effective_rank": 6, - "scaled_condition_number": 4.583568719289398, - "weakest_scaled_direction": [ - 0.7562914932594483, - 0.4643605949916133, - -0.023495647432615736, - -0.07616163300529713, - 0.1457926495420846, - 0.42986541916234255 - ] - }, - "forward_reverse": { - "translation_m": 0.015683401555203327, - "rotation_deg": 0.1727804303986473 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.930136612989092e-16, - "rotation_deg": 2.2855571068428072e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 25032, - "frame_counter_j": 25658, - "rtk_translation_m": 4.592128513798009, - "rtk_rotation_deg": 29.29312752288462, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8773104553294334, - -0.4798399067832884, - 0.008945883291650825, - 3.7298198122149056 - ], - [ - 0.4798965842179683, - 0.8773058610576113, - -0.005804705840135249, - 3.048817511626616 - ], - [ - -0.005062946334867728, - 0.009385627958138295, - 0.9999431366644013, - 0.09811158480058907 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7955, - "backend_objective": 115.14849658554162, - "backend_elapsed_sec": 0.2556408000018564, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9213780918727915, - "inlier_rmse_m": 0.3461652273570908, - "target_points": 4699, - "source_points": 4528 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8272503082614057, - "inlier_rmse_m": 0.19358532211040902, - "target_points": 8504, - "source_points": 8110 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7046058458813109, - "inlier_rmse_m": 0.1203120270687454, - "target_points": 11330, - "source_points": 11290 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 5954, - "inlier_ratio": 0.7552004058853374, - "inlier_rmse_m": 0.1130974670000902, - "median_m": 0.11060659771178058, - "p90_m": 0.603312360988425, - "p95_m": 1.0608589766217982 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3588.7458036117723, - 4633.635592609023, - 6039.6441503975975, - 7954.999999999998, - 11083.209737797062, - 13232.213062811776 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6871413543680527, - "weakest_scaled_direction": [ - 0.5018852120721368, - 0.8342788804137046, - -0.020000904330923993, - -0.11886241255956789, - 0.07578163126814247, - 0.17837830212154449 - ] - }, - "forward_reverse": { - "translation_m": 0.010357085925134528, - "rotation_deg": 0.12088315402655661 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0652501693184373e-15, - "rotation_deg": 8.133001030989358e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 25032, - "frame_counter_j": 26188, - "rtk_translation_m": 6.2188831730504885, - "rtk_rotation_deg": 74.12657521340287, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.28222015541942064, - -0.9590948730818224, - -0.022109009548160176, - 3.973939641082816 - ], - [ - 0.9593333827115965, - 0.28200613359740423, - 0.0123288859418886, - 5.00711487905302 - ], - [ - -0.005589694997331164, - -0.024689371024907588, - 0.9996795437880236, - 0.14863670073742324 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7337, - "backend_objective": 110.13676948105605, - "backend_elapsed_sec": 0.2536848000017926, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9065635451505016, - "inlier_rmse_m": 0.3985150580802805, - "target_points": 4699, - "source_points": 4784 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7791150012156577, - "inlier_rmse_m": 0.20016493654726694, - "target_points": 8504, - "source_points": 8226 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6435964912280702, - "inlier_rmse_m": 0.12251997719300589, - "target_points": 11330, - "source_points": 11400 - } - ], - "heldout_symmetric": { - "evaluated": 7753, - "inliers": 5438, - "inlier_ratio": 0.7014059073906874, - "inlier_rmse_m": 0.11707558829895812, - "median_m": 0.13172271936849078, - "p90_m": 0.752963490610791, - "p95_m": 1.1339668223325046 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3536.350778651348, - 4175.750476775939, - 5389.702022319376, - 7336.999999999999, - 11828.841952914003, - 14180.4310141545 - ], - "effective_rank": 6, - "scaled_condition_number": 4.009905097582674, - "weakest_scaled_direction": [ - -0.5628056417728142, - -0.7914495866807364, - 0.04906358095591066, - 0.17248878870517434, - -0.12828553732455347, - -0.09077755801814681 - ] - }, - "forward_reverse": { - "translation_m": 0.044382968752358344, - "rotation_deg": 0.22757601248033596 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3877787807814457e-16, - "rotation_deg": 3.3729941673279424e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 25032, - "frame_counter_j": 26803, - "rtk_translation_m": 7.344850966128434, - "rtk_rotation_deg": 112.7430048900433, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.37355923140504227, - -0.926128761202724, - -0.05233563131540124, - 2.820702783161437 - ], - [ - 0.9268848171393191, - -0.37489896328665073, - 0.018311282948099545, - 6.872780295113495 - ], - [ - -0.036579179715852284, - -0.0416687532775142, - 0.9984616560547598, - 0.11898603190092483 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6610, - "backend_objective": 110.98737709683735, - "backend_elapsed_sec": 0.31670499999745516, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8812301166489925, - "inlier_rmse_m": 0.43185177084724813, - "target_points": 4699, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.716438020578148, - "inlier_rmse_m": 0.2105344748584119, - "target_points": 8504, - "source_points": 8164 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.570565386275356, - "inlier_rmse_m": 0.1295794297243624, - "target_points": 11330, - "source_points": 11585 - } - ], - "heldout_symmetric": { - "evaluated": 7940, - "inliers": 4783, - "inlier_ratio": 0.6023929471032745, - "inlier_rmse_m": 0.12334051659083738, - "median_m": 0.1739807353679444, - "p90_m": 1.0351761889053719, - "p95_m": 1.4062235346058323 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3124.6594396275436, - 3638.730251737862, - 4657.461178740038, - 6610.000000000003, - 11114.249918496074, - 13311.254474877254 - ], - "effective_rank": 6, - "scaled_condition_number": 4.260065691019417, - "weakest_scaled_direction": [ - 0.09310874259555786, - 0.8674782362600459, - -0.06236939096664882, - -0.22084407133855447, - 0.054475732882848474, - 0.42799838950558133 - ] - }, - "forward_reverse": { - "translation_m": 0.002643716461244746, - "rotation_deg": 0.05342399356841621 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2689641549319539e-15, - "rotation_deg": 1.8185132107167794e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 25658, - "frame_counter_j": 26188, - "rtk_translation_m": 1.7043840283934533, - "rtk_rotation_deg": 44.83344769051828, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7080080301486043, - -0.7059822756667369, - -0.017710327199345337, - 1.1631730766523167 - ], - [ - 0.706155924952523, - 0.7074430142484318, - 0.02946508519484701, - 1.6057480848674226 - ], - [ - -0.008272780641341522, - -0.03336776941162999, - 0.9994089018339555, - 0.02373729417327008 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8406, - "backend_objective": 119.03724549128287, - "backend_elapsed_sec": 0.3090628999998444, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9483695652173914, - "inlier_rmse_m": 0.3252104020372252, - "target_points": 4528, - "source_points": 4784 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8679795769511306, - "inlier_rmse_m": 0.18556675474923878, - "target_points": 8110, - "source_points": 8226 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7373684210526316, - "inlier_rmse_m": 0.11899993976454012, - "target_points": 11290, - "source_points": 11400 - } - ], - "heldout_symmetric": { - "evaluated": 7771, - "inliers": 6103, - "inlier_ratio": 0.785355810063055, - "inlier_rmse_m": 0.11197405173054666, - "median_m": 0.10598489034286397, - "p90_m": 0.48942735402331855, - "p95_m": 0.7958583592676478 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4190.189749573463, - 6820.460635714948, - 7885.190252161651, - 8405.999999999998, - 10383.634857947385, - 13644.652993615124 - ], - "effective_rank": 6, - "scaled_condition_number": 3.256332960817364, - "weakest_scaled_direction": [ - 0.8241811300628129, - 0.4827843175939692, - -0.00695103058379868, - -0.08277239672247205, - 0.13772562646375627, - -0.24854945758041116 - ] - }, - "forward_reverse": { - "translation_m": 0.017947904056538493, - "rotation_deg": 0.11867936940390052 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.047382306668854e-15, - "rotation_deg": 3.7545272675846825e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 25658, - "frame_counter_j": 26803, - "rtk_translation_m": 3.3472002644811774, - "rtk_rotation_deg": 83.44987736715868, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.117714807364412, - -0.992218810953208, - -0.040559281524236886, - 1.0390528511583408 - ], - [ - 0.9919682517853713, - 0.11558513754962654, - 0.05137181549749753, - 3.7894092849039267 - ], - [ - -0.046284031555541595, - -0.04628074295251588, - 0.9978556414906558, - -0.013713852775185479 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6998, - "backend_objective": 104.19117477698144, - "backend_elapsed_sec": 0.9813823000004049, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8780487804878049, - "inlier_rmse_m": 0.4213394492649944, - "target_points": 4528, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7319941205291524, - "inlier_rmse_m": 0.1962174623464652, - "target_points": 8110, - "source_points": 8164 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6040569702201122, - "inlier_rmse_m": 0.12201929132716996, - "target_points": 11290, - "source_points": 11585 - } - ], - "heldout_symmetric": { - "evaluated": 7958, - "inliers": 4982, - "inlier_ratio": 0.6260366926363408, - "inlier_rmse_m": 0.11401170513833872, - "median_m": 0.15149379026930448, - "p90_m": 1.1347620688725466, - "p95_m": 1.5816313054479425 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3351.020794765765, - 5046.246314714325, - 6274.826022516395, - 6997.999999999998, - 8487.605310856306, - 10737.03160219473 - ], - "effective_rank": 6, - "scaled_condition_number": 3.204107721135536, - "weakest_scaled_direction": [ - 0.7429484867651776, - 0.5784485873403655, - -0.019250825775493568, - -0.10634354648335934, - 0.1268455816571021, - -0.29266949287488586 - ] - }, - "forward_reverse": { - "translation_m": 0.005088227871807909, - "rotation_deg": 0.05996016929359153 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.04605366142995e-15, - "rotation_deg": 1.6365656506980108e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 34, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 25658, - "frame_counter_j": 27410, - "rtk_translation_m": 3.311630046755356, - "rtk_rotation_deg": 133.49479301359594, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6853625570040589, - -0.726107633643495, - -0.05518939953924817, - -0.47426367112764917 - ], - [ - 0.7253335614821652, - -0.6874197502427513, - 0.03667848911544535, - 3.750338826893446 - ], - [ - -0.06457081418455211, - -0.014892660636657852, - 0.9978019936914861, - -0.060701199887776586 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7264, - "backend_objective": 104.5257598627334, - "backend_elapsed_sec": 0.30752449999999953, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8639951426836673, - "inlier_rmse_m": 0.42119958201559016, - "target_points": 4528, - "source_points": 4941 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7188208616780045, - "inlier_rmse_m": 0.19513897407480665, - "target_points": 8110, - "source_points": 8379 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.612220817530552, - "inlier_rmse_m": 0.11995648983055816, - "target_points": 11290, - "source_points": 11865 - } - ], - "heldout_symmetric": { - "evaluated": 8019, - "inliers": 5242, - "inlier_ratio": 0.6536974685122833, - "inlier_rmse_m": 0.11166700866683012, - "median_m": 0.13558539488389162, - "p90_m": 1.135706393438143, - "p95_m": 1.5036145257498004 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3554.2244490763305, - 5568.418100244199, - 6606.04499662168, - 7264.000000000001, - 8885.315233997888, - 11692.302488516212 - ], - "effective_rank": 6, - "scaled_condition_number": 3.289691648920709, - "weakest_scaled_direction": [ - 0.6315269196603726, - 0.6553550095690798, - -0.0074713315087409325, - -0.1115848395898299, - 0.10313389220222419, - -0.3854088273968455 - ] - }, - "forward_reverse": { - "translation_m": 0.01957685602042411, - "rotation_deg": 0.06586346108113965 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.793364605007606e-16, - "rotation_deg": 5.884914852775659e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 26188, - "frame_counter_j": 26803, - "rtk_translation_m": 1.9394369188755196, - "rtk_rotation_deg": 38.61642967664041, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7842360463150561, - -0.6204599761239579, - -0.0018004689340890753, - 1.4634072225016337 - ], - [ - 0.6202118866991975, - 0.7838333878297417, - 0.030699115954214918, - 1.6291721242536898 - ], - [ - -0.017636305087689635, - -0.025192025555855695, - 0.9995270494545146, - 0.026211641396796843 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8494, - "backend_objective": 122.68689374874172, - "backend_elapsed_sec": 0.475337000003492, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9554612937433722, - "inlier_rmse_m": 0.3430437887019972, - "target_points": 4784, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8462763351298384, - "inlier_rmse_m": 0.18474551896414546, - "target_points": 8226, - "source_points": 8164 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7331894691411308, - "inlier_rmse_m": 0.12018297688810804, - "target_points": 11400, - "source_points": 11585 - } - ], - "heldout_symmetric": { - "evaluated": 7827, - "inliers": 5825, - "inlier_ratio": 0.7442187300370512, - "inlier_rmse_m": 0.11487243540634488, - "median_m": 0.12112369712840347, - "p90_m": 0.5954918962817873, - "p95_m": 0.833054258992476 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4748.203660796733, - 6800.828769929276, - 8494.000000000004, - 8611.637902030767, - 8948.074444217165, - 12189.012642412798 - ], - "effective_rank": 6, - "scaled_condition_number": 2.5670787340169654, - "weakest_scaled_direction": [ - 0.9497899633455239, - -0.14585875834416984, - -0.0003164518984738977, - 0.030125866924544706, - 0.19658863299865412, - -0.1925343852883587 - ] - }, - "forward_reverse": { - "translation_m": 0.00371510987119075, - "rotation_deg": 0.04386474659625542 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.964156667291837e-15, - "rotation_deg": 8.407570630250705e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 26188, - "frame_counter_j": 27410, - "rtk_translation_m": 2.1435446082722334, - "rtk_rotation_deg": 88.6613453230776, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.02741113954305719, - -0.9993625728642868, - -0.022870885138618922, - 0.3601423937759201 - ], - [ - 0.9992054080640627, - 0.026730236073388584, - 0.029564285463893336, - 2.67307124689061 - ], - [ - -0.02893409622712804, - -0.02366310287206159, - 0.9993011936538383, - 0.00045988829841672903 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8343, - "backend_objective": 121.61108337065144, - "backend_elapsed_sec": 0.3419969000024139, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9210686095931998, - "inlier_rmse_m": 0.3655500875789656, - "target_points": 4784, - "source_points": 4941 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8222938298126268, - "inlier_rmse_m": 0.1948988605421652, - "target_points": 8226, - "source_points": 8379 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7031605562579014, - "inlier_rmse_m": 0.12073285118684787, - "target_points": 11400, - "source_points": 11865 - } - ], - "heldout_symmetric": { - "evaluated": 7888, - "inliers": 5844, - "inlier_ratio": 0.7408722109533469, - "inlier_rmse_m": 0.1145103812359268, - "median_m": 0.11946621665038355, - "p90_m": 0.6685666000586441, - "p95_m": 1.0930428959802048 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4152.969899579543, - 6201.836370263259, - 8081.835629682443, - 8343.0, - 8843.076749421074, - 11377.841885920163 - ], - "effective_rank": 6, - "scaled_condition_number": 2.7396880211128143, - "weakest_scaled_direction": [ - 0.9429784470737258, - 0.0827454119321196, - 0.010956582707696236, - -0.01075991144229859, - 0.15965445593065075, - -0.27967745254349574 - ] - }, - "forward_reverse": { - "translation_m": 0.0033854042879271646, - "rotation_deg": 0.04345206885157784 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0956423386929533e-15, - "rotation_deg": 6.38886608353287e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 35, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 26188, - "frame_counter_j": 28031, - "rtk_translation_m": 3.1027737257249126, - "rtk_rotation_deg": 119.84526039487966, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.49512088042767693, - -0.867553410038967, - -0.046972273675904, - 0.8643207053435912 - ], - [ - 0.8682891298787244, - -0.49598927873997994, - 0.008283858366870466, - -0.2171404880094779 - ], - [ - -0.030484433715746863, - -0.03668400339053286, - 0.9988618438984812, - 0.03409842386743957 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9182, - "backend_objective": 118.85871695433772, - "backend_elapsed_sec": 0.6091938000026857, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9649763644177052, - "inlier_rmse_m": 0.28350982774221867, - "target_points": 4784, - "source_points": 4654 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9088998763906057, - "inlier_rmse_m": 0.17050151566632543, - "target_points": 8226, - "source_points": 8090 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8079901443153819, - "inlier_rmse_m": 0.11377500800032275, - "target_points": 11400, - "source_points": 11364 - } - ], - "heldout_symmetric": { - "evaluated": 7613, - "inliers": 6280, - "inlier_ratio": 0.8249047681597268, - "inlier_rmse_m": 0.10651397196801952, - "median_m": 0.09704437184242566, - "p90_m": 0.4306864586320174, - "p95_m": 0.7596537598039201 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4980.229544596134, - 7693.400785370068, - 9182.0, - 9245.132329812528, - 9949.21641449309, - 13400.909669650147 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6908216879663684, - "weakest_scaled_direction": [ - 0.9436200244043977, - -0.26109064465188675, - 0.01883885727195007, - 0.053637599659666885, - 0.19081941898492055, - -0.04205923817664461 - ] - }, - "forward_reverse": { - "translation_m": 0.014229552741777998, - "rotation_deg": 0.06789311177543367 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.401625232059877e-15, - "rotation_deg": 1.925814455723798e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 34, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 26803, - "frame_counter_j": 27410, - "rtk_translation_m": 0.5704890065278277, - "rtk_rotation_deg": 50.0449156464372, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6417641656809009, - -0.766708945332621, - -0.01720897425292823, - -0.21633345575583637 - ], - [ - 0.7669018231150269, - 0.6415850848125311, - 0.015171441887480859, - 1.5001894403624116 - ], - [ - -0.0005910590031239805, - -0.02293408147360564, - 0.9997368046422104, - 0.022838119550085263 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9533, - "backend_objective": 121.38295776460491, - "backend_elapsed_sec": 0.29351549999410054, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9601295284355393, - "inlier_rmse_m": 0.29116908988435175, - "target_points": 4715, - "source_points": 4941 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8968850698174007, - "inlier_rmse_m": 0.17274965928622152, - "target_points": 8164, - "source_points": 8379 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8034555415086388, - "inlier_rmse_m": 0.11284025564622101, - "target_points": 11585, - "source_points": 11865 - } - ], - "heldout_symmetric": { - "evaluated": 8075, - "inliers": 6674, - "inlier_ratio": 0.8265015479876161, - "inlier_rmse_m": 0.1079360614731508, - "median_m": 0.09849394154346897, - "p90_m": 0.4105442964279613, - "p95_m": 0.6328305124375297 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5269.834430160783, - 7989.373111274769, - 9302.119361258596, - 9533.000000000004, - 11609.220784788966, - 15839.056951852268 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0056080815747785, - "weakest_scaled_direction": [ - -0.5199732484382951, - 0.7879530758211096, - -0.027115449906525427, - -0.17553937956349924, - -0.12438947344136624, - -0.24846671549402277 - ] - }, - "forward_reverse": { - "translation_m": 0.005517776656180037, - "rotation_deg": 0.04447304678975396 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.892244460905494e-16, - "rotation_deg": 8.529143499330578e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 26803, - "frame_counter_j": 28031, - "rtk_translation_m": 2.3843314966611664, - "rtk_rotation_deg": 81.22883071823928, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1502205242906489, - -0.9873861645272817, - -0.05002355627045966, - -1.6129700611661384 - ], - [ - 0.9886522941439911, - 0.14999430702230676, - 0.008267354154998663, - -1.0738406418383954 - ], - [ - -0.0006598224523138715, - -0.05069782994369125, - 0.9987138202074353, - -0.05835531136198311 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7971, - "backend_objective": 107.86426229259895, - "backend_elapsed_sec": 0.5136595000003581, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9235066609368285, - "inlier_rmse_m": 0.3520772952148177, - "target_points": 4715, - "source_points": 4654 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8217552533992584, - "inlier_rmse_m": 0.18443187566632632, - "target_points": 8164, - "source_points": 8090 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7014255543822597, - "inlier_rmse_m": 0.11632749718145614, - "target_points": 11585, - "source_points": 11364 - } - ], - "heldout_symmetric": { - "evaluated": 7800, - "inliers": 5483, - "inlier_ratio": 0.7029487179487179, - "inlier_rmse_m": 0.11079043369762126, - "median_m": 0.11956657147069366, - "p90_m": 0.8835449349639606, - "p95_m": 1.1685091093441604 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4096.324568682279, - 5716.84665647535, - 7375.981702772125, - 7970.999999999998, - 8817.34071536815, - 11489.524771688255 - ], - "effective_rank": 6, - "scaled_condition_number": 2.804837502264682, - "weakest_scaled_direction": [ - 0.39243271903796345, - -0.8165011560407106, - 0.01664628708987598, - 0.13331742311449044, - 0.07213012449807552, - 0.3950557355269996 - ] - }, - "forward_reverse": { - "translation_m": 0.0045321280438173584, - "rotation_deg": 0.02066446888667937 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4920648961609072e-15, - "rotation_deg": 2.1727532703221012e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 26803, - "frame_counter_j": 28788, - "rtk_translation_m": 3.5605240220038255, - "rtk_rotation_deg": 106.66041349586102, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.2880090370085819, - -0.9539307570505718, - -0.08406488776124431, - -2.1100165220217644 - ], - [ - 0.9574205909797303, - -0.288660710390434, - -0.0045613862930040635, - -2.3273378587759814 - ], - [ - -0.019914983540367383, - -0.08179917499468753, - 0.9964498423908624, - -0.09250331146873554 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6537, - "backend_objective": 96.24084143924517, - "backend_elapsed_sec": 0.33469119999790564, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8858823529411765, - "inlier_rmse_m": 0.40723857522911705, - "target_points": 4715, - "source_points": 4250 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.732215380584305, - "inlier_rmse_m": 0.19962353618892503, - "target_points": 8164, - "source_points": 7633 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6087725833488545, - "inlier_rmse_m": 0.12133622056574328, - "target_points": 11585, - "source_points": 10738 - } - ], - "heldout_symmetric": { - "evaluated": 7810, - "inliers": 4787, - "inlier_ratio": 0.612932138284251, - "inlier_rmse_m": 0.11677728789370431, - "median_m": 0.1608740640667056, - "p90_m": 1.3441642823662592, - "p95_m": 2.007926693517435 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2989.25064698578, - 4740.069869351344, - 5817.131822494454, - 6536.999999999998, - 7469.629362173694, - 9663.209414024888 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2326527799764184, - "weakest_scaled_direction": [ - -0.3806435368128638, - 0.8129618439149003, - -0.007291418117327762, - -0.11310002202665084, - -0.05674097524446054, - -0.42206542169288985 - ] - }, - "forward_reverse": { - "translation_m": 0.011704878383874686, - "rotation_deg": 0.04254924292122366 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5548697241856944e-15, - "rotation_deg": 3.2571813423526655e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 35, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 27410, - "frame_counter_j": 28031, - "rtk_translation_m": 2.9403442697824866, - "rtk_rotation_deg": 31.183915071802076, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8547723808749823, - -0.5185157795190388, - -0.02248473444534805, - -2.8737239973749733 - ], - [ - 0.518937477745475, - 0.8545506414714752, - 0.021144629385619763, - -0.5782969229097181 - ], - [ - 0.008250520255062139, - -0.029742016583511045, - 0.9995235571836547, - -0.06262744243569567 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8155, - "backend_objective": 117.51196063795429, - "backend_elapsed_sec": 0.3119414000029792, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9368285345938977, - "inlier_rmse_m": 0.3529879436761389, - "target_points": 4941, - "source_points": 4654 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8355995055624228, - "inlier_rmse_m": 0.1885437235051724, - "target_points": 8379, - "source_points": 8090 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7176170362548399, - "inlier_rmse_m": 0.12004084765536706, - "target_points": 11865, - "source_points": 11364 - } - ], - "heldout_symmetric": { - "evaluated": 7861, - "inliers": 5659, - "inlier_ratio": 0.7198829665436968, - "inlier_rmse_m": 0.11381984857774002, - "median_m": 0.1207537544795301, - "p90_m": 0.7491290093571489, - "p95_m": 1.1677691569784274 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3843.35570250274, - 5856.703883820844, - 7029.549982431027, - 8155.0, - 9722.914526477009, - 12668.413207634192 - ], - "effective_rank": 6, - "scaled_condition_number": 3.296185466097946, - "weakest_scaled_direction": [ - -0.25140472480410175, - -0.8318291056688679, - 0.00298802072780968, - 0.1198115418094086, - -0.03449068698941616, - 0.47885557530500394 - ] - }, - "forward_reverse": { - "translation_m": 0.015242618456135898, - "rotation_deg": 0.1219677981121258 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.582495395355895e-16, - "rotation_deg": 1.8430387199773426e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 27410, - "frame_counter_j": 28788, - "rtk_translation_m": 4.102710388907318, - "rtk_rotation_deg": 56.61549784942384, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5493708899433927, - -0.8339042594301863, - -0.052870704430684465, - -4.160401094888543 - ], - [ - 0.835556888652739, - 0.5477994765281058, - 0.0419573514474718, - -1.0122162144318074 - ], - [ - -0.006025869875654907, - -0.06722662879934659, - 0.9977195343745237, - -0.1250123699433948 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6668, - "backend_objective": 97.79711231622866, - "backend_elapsed_sec": 0.336147300004086, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.892235294117647, - "inlier_rmse_m": 0.4022957936334243, - "target_points": 4941, - "source_points": 4250 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7586794183152102, - "inlier_rmse_m": 0.20101218391424935, - "target_points": 8379, - "source_points": 7633 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6209722480908921, - "inlier_rmse_m": 0.12110587731704087, - "target_points": 11865, - "source_points": 10738 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 5077, - "inlier_ratio": 0.6450260449752255, - "inlier_rmse_m": 0.11677131628998773, - "median_m": 0.1459951464395087, - "p90_m": 1.2730700532651762, - "p95_m": 1.7545867532251103 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2938.0619253697428, - 4941.269593302857, - 5745.8893639130065, - 6668.0, - 8219.70206052786, - 10828.09615487445 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6854553885932066, - "weakest_scaled_direction": [ - -0.20528002053135871, - -0.8353743108184787, - -0.0009174854889368931, - 0.11053042610176081, - -0.02770697198179012, - 0.49701547342606817 - ] - }, - "forward_reverse": { - "translation_m": 0.0029445631740664846, - "rotation_deg": 0.0910859237401823 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3940692376154064e-15, - "rotation_deg": 7.779974185313971e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 37, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 27410, - "frame_counter_j": 29564, - "rtk_translation_m": 3.6865711881345757, - "rtk_rotation_deg": 30.12086856551724, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.86267894255448, - -0.5056725371878031, - -0.008962544679606615, - 0.9708582265040203 - ], - [ - 0.5057498657210949, - 0.862488943902761, - 0.018163011000253294, - 4.166623308552961 - ], - [ - -0.0014544401600728486, - -0.02020165289153427, - 0.9997948678725408, - 0.07444878919283267 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8196, - "backend_objective": 127.35848577221961, - "backend_elapsed_sec": 0.3196146999980556, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9304401993355482, - "inlier_rmse_m": 0.3615762672756092, - "target_points": 4941, - "source_points": 4816 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.813778256189451, - "inlier_rmse_m": 0.1916416752411471, - "target_points": 8379, - "source_points": 8361 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6962283384301733, - "inlier_rmse_m": 0.12465593730444152, - "target_points": 11865, - "source_points": 11772 - } - ], - "heldout_symmetric": { - "evaluated": 8053, - "inliers": 5533, - "inlier_ratio": 0.6870731404445548, - "inlier_rmse_m": 0.11846537329500156, - "median_m": 0.13898488824061134, - "p90_m": 0.8987859616257862, - "p95_m": 1.3703492011543583 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3387.7602011967383, - 5847.823313079612, - 6668.854657603184, - 8196.000000000002, - 12291.509949255917, - 15380.419272085172 - ], - "effective_rank": 6, - "scaled_condition_number": 4.5399964456315365, - "weakest_scaled_direction": [ - 0.355603366868407, - 0.79242844102367, - -0.029980402345626166, - -0.14586587166451664, - 0.047665441818273695, - -0.47027198507211054 - ] - }, - "forward_reverse": { - "translation_m": 0.013941395463696922, - "rotation_deg": 0.12307688004234886 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4177095929570765e-15, - "rotation_deg": 8.774620364632645e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "lidar_time_i": 1784283483.1839027, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 28031, - "frame_counter_j": 28788, - "rtk_translation_m": 1.2045561534352058, - "rtk_rotation_deg": 25.431582777621774, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9033441981615404, - -0.4286612501907939, - -0.014791627116243279, - -1.316150999764575 - ], - [ - 0.4289140489173016, - 0.902915625406467, - 0.02785878745063317, - 0.3095746482666318 - ], - [ - 0.0014136085910540466, - -0.03151041068784781, - 0.9995024240736176, - -0.03438418117411335 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8590, - "backend_objective": 123.57963004473682, - "backend_elapsed_sec": 0.489260700000159, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9738823529411764, - "inlier_rmse_m": 0.29715024825346203, - "target_points": 4654, - "source_points": 4250 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9225730381239355, - "inlier_rmse_m": 0.18063402134975134, - "target_points": 8090, - "source_points": 7633 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7999627491152915, - "inlier_rmse_m": 0.1199435402902619, - "target_points": 11364, - "source_points": 10738 - } - ], - "heldout_symmetric": { - "evaluated": 7596, - "inliers": 6162, - "inlier_ratio": 0.811216429699842, - "inlier_rmse_m": 0.11156358795429076, - "median_m": 0.10047782134166522, - "p90_m": 0.41697101218280397, - "p95_m": 0.6792385579832404 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4421.869938947818, - 6862.600578483724, - 8590.000000000004, - 8703.998190858576, - 8841.961086603344, - 11417.762993164324 - ], - "effective_rank": 6, - "scaled_condition_number": 2.5821119008039335, - "weakest_scaled_direction": [ - 0.817862961240245, - 0.5511384186221566, - 0.015991620890295155, - -0.08733906729868997, - 0.13099913002414598, - -0.04797919828027951 - ] - }, - "forward_reverse": { - "translation_m": 0.003966448406861189, - "rotation_deg": 0.11486278330291146 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.389157964038493e-16, - "rotation_deg": 8.244899441638921e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "lidar_time_i": 1784283483.1839027, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 28031, - "frame_counter_j": 29564, - "rtk_translation_m": 6.084062615492111, - "rtk_rotation_deg": 1.063046506284832, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9998382848880676, - 0.014748133963318765, - 0.010290608178732601, - 5.744801065139025 - ], - [ - -0.014616013744547044, - 0.9998112722880186, - -0.012798122832398296, - 2.0579209365971916 - ], - [ - -0.010477414485807348, - 0.012645645511951817, - 0.9998651466249225, - 0.1567922174841059 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7834, - "backend_objective": 129.0265119804988, - "backend_elapsed_sec": 0.35935840000456665, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8995016611295681, - "inlier_rmse_m": 0.382945710231371, - "target_points": 4654, - "source_points": 4816 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7841167324482717, - "inlier_rmse_m": 0.19885069880025008, - "target_points": 8090, - "source_points": 8361 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.665477404009514, - "inlier_rmse_m": 0.12833576238377523, - "target_points": 11364, - "source_points": 11772 - } - ], - "heldout_symmetric": { - "evaluated": 7778, - "inliers": 5380, - "inlier_ratio": 0.6916945230136282, - "inlier_rmse_m": 0.12226449151266647, - "median_m": 0.14175710510514608, - "p90_m": 0.8173654162842785, - "p95_m": 1.370508880986626 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3821.180615510412, - 4228.732365344067, - 5636.300260836557, - 7834.000000000002, - 12480.734990230208, - 14926.32609783131 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9062079497745845, - "weakest_scaled_direction": [ - 0.7592201690730459, - 0.6007320841246818, - -0.06470991957668208, - -0.14741860879864804, - 0.1894995093012544, - 0.02959753433559086 - ] - }, - "forward_reverse": { - "translation_m": 0.012490325532322776, - "rotation_deg": 0.1588294259454204 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5509306388191833e-13, - "rotation_deg": 3.685371140695946e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 36, - "j": 37, - "lidar_time_i": 1784283558.880709, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 28788, - "frame_counter_j": 29564, - "rtk_translation_m": 7.2781244258509386, - "rtk_rotation_deg": 26.494629283906598, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8969455376688386, - 0.4421196607100144, - 0.004348341019224733, - 7.13862696111329 - ], - [ - -0.4413098085617857, - 0.8958187380263459, - -0.05248277305978556, - -1.4480720315939786 - ], - [ - -0.02709899118266317, - 0.04515522355770556, - 0.9986123624621993, - 0.12362123540971545 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7125, - "backend_objective": 120.22410634193291, - "backend_elapsed_sec": 0.3152983999971184, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8544435215946844, - "inlier_rmse_m": 0.39897502777899907, - "target_points": 4250, - "source_points": 4816 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7359167563688555, - "inlier_rmse_m": 0.2060089241880448, - "target_points": 7633, - "source_points": 8361 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.605249745158002, - "inlier_rmse_m": 0.12989826320945438, - "target_points": 10738, - "source_points": 11772 - } - ], - "heldout_symmetric": { - "evaluated": 7788, - "inliers": 4989, - "inlier_ratio": 0.6406009244992296, - "inlier_rmse_m": 0.123972843683949, - "median_m": 0.15901204847718076, - "p90_m": 1.1623965281742321, - "p95_m": 1.7092054504127763 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3266.826792004189, - 3702.5557865947503, - 4721.811432612261, - 7124.9999999999945, - 12716.153465177696, - 15020.541740019657 - ], - "effective_rank": 6, - "scaled_condition_number": 4.59789964279208, - "weakest_scaled_direction": [ - 0.7483809968927112, - 0.4228920528959654, - -0.02961152122063967, - -0.07369545670976635, - 0.16384691091994946, - 0.4774248865954063 - ] - }, - "forward_reverse": { - "translation_m": 0.011995188628592031, - "rotation_deg": 0.19550165133048591 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3232745389513375e-15, - "rotation_deg": 5.324073676075921e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - } - ] -} diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.npz b/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.npz deleted file mode 100644 index 026f417..0000000 Binary files a/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.npz and /dev/null differ diff --git a/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.refinement.json b/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.refinement.json deleted file mode 100644 index 5fca1fc..0000000 --- a/results/01_previous_two_batches/open3d_gicp/B_batch2_refined.refinement.json +++ /dev/null @@ -1,1289 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 108, - "accepted_pairs": 66, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.7947725072604066, - "heldout_inlier_rmse_m": 0.09714510386272111, - "rotation_invariant_error_deg": 0.04809058452666726, - "reverse_translation_m": 0.00040681040655899406, - "reverse_rotation_deg": 0.015836974306118006, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.8196783588704571, - "heldout_inlier_rmse_m": 0.10111548255452249, - "rotation_invariant_error_deg": 0.3344524749039408, - "reverse_translation_m": 0.0024786662018318395, - "reverse_rotation_deg": 0.04305117802148083, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.8170202208162759, - "heldout_inlier_rmse_m": 0.10132889132333661, - "rotation_invariant_error_deg": 0.3912246699964612, - "reverse_translation_m": 0.001763337668740155, - "reverse_rotation_deg": 0.0152261810177797, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "heldout_inlier_ratio": 0.7847728726807421, - "heldout_inlier_rmse_m": 0.08513837010948266, - "rotation_invariant_error_deg": 0.35537843226006416, - "reverse_translation_m": 0.003621881376895638, - "reverse_rotation_deg": 0.011153493139183525, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.7885699962401304, - "heldout_inlier_rmse_m": 0.09713251502799032, - "rotation_invariant_error_deg": 0.39303450319222577, - "reverse_translation_m": 0.0014094469663425105, - "reverse_rotation_deg": 0.02902143941632062, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "heldout_inlier_ratio": 0.7363658899355479, - "heldout_inlier_rmse_m": 0.09863727794945644, - "rotation_invariant_error_deg": 0.11917413757267781, - "reverse_translation_m": 0.011592408190980286, - "reverse_rotation_deg": 0.17084480097436408, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.918286915396742, - "heldout_inlier_rmse_m": 0.07288259780013887, - "rotation_invariant_error_deg": 0.03973468092636878, - "reverse_translation_m": 0.002273707715582919, - "reverse_rotation_deg": 0.0026923349652342365, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.8370341514089079, - "heldout_inlier_rmse_m": 0.09441127521663696, - "rotation_invariant_error_deg": 0.5168911066454953, - "reverse_translation_m": 0.0041401597740440875, - "reverse_rotation_deg": 0.03075174550917053, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.8235371293623721, - "heldout_inlier_rmse_m": 0.10626795357026747, - "rotation_invariant_error_deg": 0.3802251881160217, - "reverse_translation_m": 0.009148796674106823, - "reverse_rotation_deg": 0.05256412309062332, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.8850603941513032, - "heldout_inlier_rmse_m": 0.07613142655207121, - "rotation_invariant_error_deg": 0.5739182611426337, - "reverse_translation_m": 0.0013904645484531576, - "reverse_rotation_deg": 0.0259404694028417, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.8740046236835346, - "heldout_inlier_rmse_m": 0.09072202522560696, - "rotation_invariant_error_deg": 0.4805217860834574, - "reverse_translation_m": 0.006509933107990933, - "reverse_rotation_deg": 0.02545212192512678, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.6795928884308168, - "heldout_inlier_rmse_m": 0.10271649349323747, - "rotation_invariant_error_deg": 0.5311416787880745, - "reverse_translation_m": 0.00828154435242913, - "reverse_rotation_deg": 0.026486510290724834, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.8684444444444445, - "heldout_inlier_rmse_m": 0.0784387700526441, - "rotation_invariant_error_deg": 0.09482188296834693, - "reverse_translation_m": 0.0025072579888539386, - "reverse_rotation_deg": 0.021042298559759365, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6781301745000636, - "heldout_inlier_rmse_m": 0.10313081772493418, - "rotation_invariant_error_deg": 0.014345316682458531, - "reverse_translation_m": 0.003271195715147848, - "reverse_rotation_deg": 0.14716032493381534, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.7873548387096774, - "heldout_inlier_rmse_m": 0.09891997778736471, - "rotation_invariant_error_deg": 0.29405162160286125, - "reverse_translation_m": 0.004633577062239209, - "reverse_rotation_deg": 0.04472721629193465, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.6911991765311374, - "heldout_inlier_rmse_m": 0.10152400788085783, - "rotation_invariant_error_deg": 0.12387448324201955, - "reverse_translation_m": 0.005288907067525738, - "reverse_rotation_deg": 0.05494235971756111, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.7747360187719984, - "heldout_inlier_rmse_m": 0.09121609616459708, - "rotation_invariant_error_deg": 0.3986069595444377, - "reverse_translation_m": 0.00421464356720393, - "reverse_rotation_deg": 0.015634168997181876, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.7829477514946712, - "heldout_inlier_rmse_m": 0.10577559680144696, - "rotation_invariant_error_deg": 0.09832934586458464, - "reverse_translation_m": 0.0033105282814613057, - "reverse_rotation_deg": 0.030813019102438145, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.7347979599843075, - "heldout_inlier_rmse_m": 0.10196810239533251, - "rotation_invariant_error_deg": 0.32649066640074764, - "reverse_translation_m": 0.004020707752206965, - "reverse_rotation_deg": 0.039850323489805044, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.7155149934810952, - "heldout_inlier_rmse_m": 0.10460245111398395, - "rotation_invariant_error_deg": 0.19138520990776442, - "reverse_translation_m": 0.0072368624874882504, - "reverse_rotation_deg": 0.0055907688631446776, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "heldout_inlier_ratio": 0.6825438366919655, - "heldout_inlier_rmse_m": 0.10495957402394829, - "rotation_invariant_error_deg": 0.16852728038516318, - "reverse_translation_m": 0.00430894236478819, - "reverse_rotation_deg": 0.13911475434755866, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.8127890077949531, - "heldout_inlier_rmse_m": 0.09942756972076687, - "rotation_invariant_error_deg": 0.4807027094673302, - "reverse_translation_m": 0.008316114154115147, - "reverse_rotation_deg": 0.01814737917470093, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "heldout_inlier_ratio": 0.8193873491579367, - "heldout_inlier_rmse_m": 0.09507291602212191, - "rotation_invariant_error_deg": 0.4765128702231962, - "reverse_translation_m": 0.006751593996528964, - "reverse_rotation_deg": 0.029293578235221863, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "heldout_inlier_ratio": 0.7940216681895313, - "heldout_inlier_rmse_m": 0.10356080767641777, - "rotation_invariant_error_deg": 0.28342220494138104, - "reverse_translation_m": 0.006883567504360684, - "reverse_rotation_deg": 0.016492683422577963, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "heldout_inlier_ratio": 0.8581438392384981, - "heldout_inlier_rmse_m": 0.09484304022144129, - "rotation_invariant_error_deg": 0.004617935717304178, - "reverse_translation_m": 0.007253035671159373, - "reverse_rotation_deg": 0.024252719250072975, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.8015356585111921, - "heldout_inlier_rmse_m": 0.10152298131640612, - "rotation_invariant_error_deg": 0.20342458284812182, - "reverse_translation_m": 0.0017523919908150464, - "reverse_rotation_deg": 0.05042176209078739, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "heldout_inlier_ratio": 0.688687555052221, - "heldout_inlier_rmse_m": 0.10536230082368817, - "rotation_invariant_error_deg": 0.10168847704856887, - "reverse_translation_m": 0.0036281146181207165, - "reverse_rotation_deg": 0.013078005975049522, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.8560606060606061, - "heldout_inlier_rmse_m": 0.09594368034796862, - "rotation_invariant_error_deg": 0.21300619233473128, - "reverse_translation_m": 0.010491037599418197, - "reverse_rotation_deg": 0.0599937188173442, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.6966788735951509, - "heldout_inlier_rmse_m": 0.10384409271666459, - "rotation_invariant_error_deg": 0.13456747468753605, - "reverse_translation_m": 0.009543265092514783, - "reverse_rotation_deg": 0.09977883713501384, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.6579243162233046, - "heldout_inlier_rmse_m": 0.10621203405076814, - "rotation_invariant_error_deg": 0.06414650789096754, - "reverse_translation_m": 0.0028782078295197843, - "reverse_rotation_deg": 0.0743495992598884, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.729195173529046, - "heldout_inlier_rmse_m": 0.10869447817964137, - "rotation_invariant_error_deg": 0.3005297011657433, - "reverse_translation_m": 0.0028206125960216254, - "reverse_rotation_deg": 0.014140069566934874, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.6945982527377876, - "heldout_inlier_rmse_m": 0.10596349826421764, - "rotation_invariant_error_deg": 0.10487617202333155, - "reverse_translation_m": 0.005660464094292755, - "reverse_rotation_deg": 0.08952914345108036, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.6530587074494326, - "heldout_inlier_rmse_m": 0.1098871098886565, - "rotation_invariant_error_deg": 0.1285131052864159, - "reverse_translation_m": 0.009441275754405344, - "reverse_rotation_deg": 0.06902225135435515, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.865792610250298, - "heldout_inlier_rmse_m": 0.09248705530398661, - "rotation_invariant_error_deg": 0.19351022128666884, - "reverse_translation_m": 0.007654923324833218, - "reverse_rotation_deg": 0.03083951917063289, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.8217656194003106, - "heldout_inlier_rmse_m": 0.10443913508460159, - "rotation_invariant_error_deg": 0.1734228807465783, - "reverse_translation_m": 0.0019958122994113434, - "reverse_rotation_deg": 0.04243931133970266, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.7462918660287081, - "heldout_inlier_rmse_m": 0.10754571546972236, - "rotation_invariant_error_deg": 0.6412389592635037, - "reverse_translation_m": 0.0030226348073827927, - "reverse_rotation_deg": 0.05528144266002643, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.8347322378531742, - "heldout_inlier_rmse_m": 0.10791137431619166, - "rotation_invariant_error_deg": 0.020978161925214067, - "reverse_translation_m": 0.0033753816186126483, - "reverse_rotation_deg": 0.015427430722607398, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.7626657196969697, - "heldout_inlier_rmse_m": 0.10926443071446633, - "rotation_invariant_error_deg": 0.46492648280225524, - "reverse_translation_m": 0.0011083901763643633, - "reverse_rotation_deg": 0.03408686226954418, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "heldout_inlier_ratio": 0.7404945183111733, - "heldout_inlier_rmse_m": 0.10470183850479874, - "rotation_invariant_error_deg": 0.28492671157374616, - "reverse_translation_m": 0.008442575945215317, - "reverse_rotation_deg": 0.02844707164454242, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.8138569225293629, - "heldout_inlier_rmse_m": 0.1125369920515294, - "rotation_invariant_error_deg": 0.4997272579352625, - "reverse_translation_m": 0.005457899756974233, - "reverse_rotation_deg": 0.04250371025579654, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.7853886616014026, - "heldout_inlier_rmse_m": 0.10710393317615087, - "rotation_invariant_error_deg": 0.24720654046684842, - "reverse_translation_m": 0.0023363953219779758, - "reverse_rotation_deg": 0.003679886698275418, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "heldout_inlier_ratio": 0.7461059190031153, - "heldout_inlier_rmse_m": 0.10791684095774041, - "rotation_invariant_error_deg": 0.2294926394110064, - "reverse_translation_m": 0.0023169831632091926, - "reverse_rotation_deg": 0.02473862097872449, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "heldout_inlier_ratio": 0.7456694756554307, - "heldout_inlier_rmse_m": 0.11049010248131722, - "rotation_invariant_error_deg": 0.687876982748918, - "reverse_translation_m": 0.0027632919724097076, - "reverse_rotation_deg": 0.05272762900968177, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.7114577084583084, - "heldout_inlier_rmse_m": 0.11170286188791147, - "rotation_invariant_error_deg": 0.6990027975092303, - "reverse_translation_m": 0.0043726035924820505, - "reverse_rotation_deg": 0.11525585711885118, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.6170986278878855, - "heldout_inlier_rmse_m": 0.11803645680912848, - "rotation_invariant_error_deg": 0.18840789678801428, - "reverse_translation_m": 0.02802927019183766, - "reverse_rotation_deg": 0.10048860643286558, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.7687034629476421, - "heldout_inlier_rmse_m": 0.09834033850996364, - "rotation_invariant_error_deg": 0.03234607880271767, - "reverse_translation_m": 0.004926598691892943, - "reverse_rotation_deg": 0.10049788043616295, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.5596902808274586, - "heldout_inlier_rmse_m": 0.12817180913542037, - "rotation_invariant_error_deg": 0.20529117710791667, - "reverse_translation_m": 0.04660873899639204, - "reverse_rotation_deg": 0.08128930035257874, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 18, - "heldout_inlier_ratio": 0.6134687462217386, - "heldout_inlier_rmse_m": 0.11861991782546771, - "rotation_invariant_error_deg": 0.942967342691837, - "reverse_translation_m": 0.006137337753783083, - "reverse_rotation_deg": 0.040498570689394164, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.589649455234486, - "heldout_inlier_rmse_m": 0.12715782204597983, - "rotation_invariant_error_deg": 0.13075131693057784, - "reverse_translation_m": 0.016491489842564398, - "reverse_rotation_deg": 0.29283865924681673, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 18, - "heldout_inlier_ratio": 0.6441329694864798, - "heldout_inlier_rmse_m": 0.11977657776801591, - "rotation_invariant_error_deg": 4.443872790866922, - "reverse_translation_m": 0.01581702082704062, - "reverse_rotation_deg": 0.07681086634765077, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 16, - "j": 19, - "heldout_inlier_ratio": 0.642055375405338, - "heldout_inlier_rmse_m": 0.11922626532224312, - "rotation_invariant_error_deg": 0.04917021503691643, - "reverse_translation_m": 0.01936736899083179, - "reverse_rotation_deg": 0.22155509936605944, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.761206687666586, - "heldout_inlier_rmse_m": 0.10248796635270672, - "rotation_invariant_error_deg": 0.10160395664127009, - "reverse_translation_m": 0.003602819302929225, - "reverse_rotation_deg": 0.04280787772842571, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.6654080389768575, - "heldout_inlier_rmse_m": 0.10560001932239894, - "rotation_invariant_error_deg": 0.6258084500000791, - "reverse_translation_m": 0.015683211248127868, - "reverse_rotation_deg": 0.18051709633786264, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 20, - "heldout_inlier_ratio": 0.6377810007251632, - "heldout_inlier_rmse_m": 0.11215519048187066, - "rotation_invariant_error_deg": 0.5735867899105642, - "reverse_translation_m": 0.016926609942259613, - "reverse_rotation_deg": 0.20634229894075337, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.7556208482370976, - "heldout_inlier_rmse_m": 0.10994458141969204, - "rotation_invariant_error_deg": 0.7108560388263427, - "reverse_translation_m": 0.004654350735545165, - "reverse_rotation_deg": 0.12873243616635754, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "heldout_inlier_ratio": 0.6686517992904207, - "heldout_inlier_rmse_m": 0.11525187440612464, - "rotation_invariant_error_deg": 0.46983417972798236, - "reverse_translation_m": 0.022993775653731053, - "reverse_rotation_deg": 0.1013964892640344, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 21, - "heldout_inlier_ratio": 0.5905541093343251, - "heldout_inlier_rmse_m": 0.1262853354637165, - "rotation_invariant_error_deg": 0.1887084476369978, - "reverse_translation_m": 0.021857815102479028, - "reverse_rotation_deg": 0.4259066161744867, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 20, - "heldout_inlier_ratio": 0.7420998980632009, - "heldout_inlier_rmse_m": 0.12052023632629244, - "rotation_invariant_error_deg": 1.1839799204341972, - "reverse_translation_m": 0.012566250876576632, - "reverse_rotation_deg": 0.08500209892702067, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 19, - "j": 21, - "heldout_inlier_ratio": 0.6515019319456562, - "heldout_inlier_rmse_m": 0.12055764747498063, - "rotation_invariant_error_deg": 0.5459732481836568, - "reverse_translation_m": 0.007120603737667027, - "reverse_rotation_deg": 0.05561876226347328, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 22, - "heldout_inlier_ratio": 0.5905501782985226, - "heldout_inlier_rmse_m": 0.12548545004843537, - "rotation_invariant_error_deg": 0.6800369087587796, - "reverse_translation_m": 0.005772061596466365, - "reverse_rotation_deg": 0.10356450735473072, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.7791517249907258, - "heldout_inlier_rmse_m": 0.1109933103332085, - "rotation_invariant_error_deg": 0.6492458365403877, - "reverse_translation_m": 0.004882992437392809, - "reverse_rotation_deg": 0.09954673132586826, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.6575290550783224, - "heldout_inlier_rmse_m": 0.11893104898070972, - "rotation_invariant_error_deg": 0.5028041376461232, - "reverse_translation_m": 0.005511015274661758, - "reverse_rotation_deg": 0.13108161960065734, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.5799237611181702, - "heldout_inlier_rmse_m": 0.12732395079162134, - "rotation_invariant_error_deg": 0.34339971072861886, - "reverse_translation_m": 0.02421237470645105, - "reverse_rotation_deg": 0.2728497258921342, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7379804721295267, - "heldout_inlier_rmse_m": 0.11301282071283571, - "rotation_invariant_error_deg": 0.1436731759976979, - "reverse_translation_m": 0.005342970038949662, - "reverse_rotation_deg": 0.023692959917636515, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.6154133001864512, - "heldout_inlier_rmse_m": 0.11796945645750438, - "rotation_invariant_error_deg": 0.33718850502100395, - "reverse_translation_m": 0.021862964848253088, - "reverse_rotation_deg": 0.18671115674675795, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.6688601936925751, - "heldout_inlier_rmse_m": 0.11271893154362743, - "rotation_invariant_error_deg": 0.01992720169847928, - "reverse_translation_m": 0.017882487871653564, - "reverse_rotation_deg": 0.11231417140662198, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.7269494538989077, - "heldout_inlier_rmse_m": 0.11696827793053062, - "rotation_invariant_error_deg": 0.22617626489579834, - "reverse_translation_m": 0.036708381465019306, - "reverse_rotation_deg": 0.17149160359500737, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.7625269567423569, - "heldout_inlier_rmse_m": 0.11122908154278312, - "rotation_invariant_error_deg": 0.12499536949599133, - "reverse_translation_m": 0.033708002403797385, - "reverse_rotation_deg": 0.18898419347187523, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.7063042657606644, - "heldout_inlier_rmse_m": 0.1109686247290255, - "rotation_invariant_error_deg": 0.22582229467013804, - "reverse_translation_m": 0.0237546710240931, - "reverse_rotation_deg": 0.20388046327310663, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.785377057547531, - "heldout_inlier_rmse_m": 0.11259637754562075, - "rotation_invariant_error_deg": 0.2878599774707524, - "reverse_translation_m": 0.008388924730327863, - "reverse_rotation_deg": 0.09824473511740778, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.682445260093659, - "heldout_inlier_rmse_m": 0.11585305930039552, - "rotation_invariant_error_deg": 0.40582771446327115, - "reverse_translation_m": 0.03262070035564156, - "reverse_rotation_deg": 0.26820774135203534, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6190717727618564, - "heldout_inlier_rmse_m": 0.1225437625254746, - "rotation_invariant_error_deg": 0.33650101357832796, - "reverse_translation_m": 0.020450511219618477, - "reverse_rotation_deg": 0.11876511292532045, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.7662452591656131, - "heldout_inlier_rmse_m": 0.10751986617832841, - "rotation_invariant_error_deg": 0.10109109528606552, - "reverse_translation_m": 0.020801978066425954, - "reverse_rotation_deg": 0.11499836231449187, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.7051298290056998, - "heldout_inlier_rmse_m": 0.11713046861462412, - "rotation_invariant_error_deg": 0.042445120275061754, - "reverse_translation_m": 0.02866879831073192, - "reverse_rotation_deg": 0.14020373652670878, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.7231216797369087, - "heldout_inlier_rmse_m": 0.11332956637109663, - "rotation_invariant_error_deg": 0.2020596733246407, - "reverse_translation_m": 0.0391123663878616, - "reverse_rotation_deg": 0.31745415833557195, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.8146752104535746, - "heldout_inlier_rmse_m": 0.1067005622933313, - "rotation_invariant_error_deg": 0.07172573654509051, - "reverse_translation_m": 0.015155094735859666, - "reverse_rotation_deg": 0.09937091691588736, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.8480552070263488, - "heldout_inlier_rmse_m": 0.10282262567757873, - "rotation_invariant_error_deg": 0.3049826868718668, - "reverse_translation_m": 0.020178532297188766, - "reverse_rotation_deg": 0.14259764688967286, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "heldout_inlier_ratio": 0.6516274978006786, - "heldout_inlier_rmse_m": 0.11571138405667894, - "rotation_invariant_error_deg": 0.22784608149572705, - "reverse_translation_m": 0.012932261164889271, - "reverse_rotation_deg": 0.1340627397278959, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.8667504714016342, - "heldout_inlier_rmse_m": 0.10966038141955464, - "rotation_invariant_error_deg": 0.23625340043006204, - "reverse_translation_m": 0.0016799531047772863, - "reverse_rotation_deg": 0.021489450960699312, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.7044824981113069, - "heldout_inlier_rmse_m": 0.11528623479803272, - "rotation_invariant_error_deg": 0.2990492285575215, - "reverse_translation_m": 0.011526585390891731, - "reverse_rotation_deg": 0.12425176309998268, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "heldout_inlier_ratio": 0.713654161930024, - "heldout_inlier_rmse_m": 0.11136018082941974, - "rotation_invariant_error_deg": 0.3693542114705224, - "reverse_translation_m": 0.0026952303885011083, - "reverse_rotation_deg": 0.026655596724504224, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.7058971457311706, - "heldout_inlier_rmse_m": 0.1123767383226778, - "rotation_invariant_error_deg": 0.5184790270336777, - "reverse_translation_m": 0.004853942846193662, - "reverse_rotation_deg": 0.04151426276015074, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7564328960645812, - "heldout_inlier_rmse_m": 0.11469589052522192, - "rotation_invariant_error_deg": 0.15677852100955647, - "reverse_translation_m": 0.012664149059349924, - "reverse_rotation_deg": 0.06847473063899887, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "heldout_inlier_ratio": 0.7694542698332492, - "heldout_inlier_rmse_m": 0.10812761282109745, - "rotation_invariant_error_deg": 0.5344878240348123, - "reverse_translation_m": 0.029100131201629794, - "reverse_rotation_deg": 0.2714584305620497, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.6751737207833228, - "heldout_inlier_rmse_m": 0.11779777341629802, - "rotation_invariant_error_deg": 0.6738366594714833, - "reverse_translation_m": 0.02178556321929983, - "reverse_rotation_deg": 0.16690946122682282, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 30, - "heldout_inlier_ratio": 0.6491205871188156, - "heldout_inlier_rmse_m": 0.12153627244194264, - "rotation_invariant_error_deg": 0.006534941539179329, - "reverse_translation_m": 0.03128065038149053, - "reverse_rotation_deg": 0.11076032475862632, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 31, - "heldout_inlier_ratio": 0.5547279383916173, - "heldout_inlier_rmse_m": 0.13098667045941628, - "rotation_invariant_error_deg": 0.7205255326899227, - "reverse_translation_m": 0.007811024872033181, - "reverse_rotation_deg": 0.25693805699014277, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 29, - "j": 30, - "heldout_inlier_ratio": 0.8093424727088093, - "heldout_inlier_rmse_m": 0.11457686827315132, - "rotation_invariant_error_deg": 0.6701730199605365, - "reverse_translation_m": 0.011632920497220726, - "reverse_rotation_deg": 0.07792616982135933, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "heldout_inlier_ratio": 0.7190982776089159, - "heldout_inlier_rmse_m": 0.1179079898277715, - "rotation_invariant_error_deg": 2.094899191496171, - "reverse_translation_m": 0.010102013331328315, - "reverse_rotation_deg": 0.05295397679545269, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 29, - "j": 32, - "heldout_inlier_ratio": 0.683451384417257, - "heldout_inlier_rmse_m": 0.12293657670032715, - "rotation_invariant_error_deg": 0.19727753983803353, - "reverse_translation_m": 0.015683401555203327, - "reverse_rotation_deg": 0.1727804303986473, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.7552004058853374, - "heldout_inlier_rmse_m": 0.1130974670000902, - "rotation_invariant_error_deg": 0.6090670402331249, - "reverse_translation_m": 0.010357085925134528, - "reverse_rotation_deg": 0.12088315402655661, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.7014059073906874, - "heldout_inlier_rmse_m": 0.11707558829895812, - "rotation_invariant_error_deg": 0.5033707131802885, - "reverse_translation_m": 0.044382968752358344, - "reverse_rotation_deg": 0.22757601248033596, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "heldout_inlier_ratio": 0.6023929471032745, - "heldout_inlier_rmse_m": 0.12334051659083738, - "rotation_invariant_error_deg": 0.718799019620505, - "reverse_translation_m": 0.002643716461244746, - "reverse_rotation_deg": 0.05342399356841621, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.785355810063055, - "heldout_inlier_rmse_m": 0.11197405173054666, - "rotation_invariant_error_deg": 0.140358574095238, - "reverse_translation_m": 0.017947904056538493, - "reverse_rotation_deg": 0.11867936940390052, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "heldout_inlier_ratio": 0.6260366926363408, - "heldout_inlier_rmse_m": 0.11401170513833872, - "rotation_invariant_error_deg": 0.0868297548644108, - "reverse_translation_m": 0.005088227871807909, - "reverse_rotation_deg": 0.05996016929359153, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 31, - "j": 34, - "heldout_inlier_ratio": 0.6536974685122833, - "heldout_inlier_rmse_m": 0.11166700866683012, - "rotation_invariant_error_deg": 0.06303307879016984, - "reverse_translation_m": 0.01957685602042411, - "reverse_rotation_deg": 0.06586346108113965, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 32, - "j": 33, - "heldout_inlier_ratio": 0.7442187300370512, - "heldout_inlier_rmse_m": 0.11487243540634488, - "rotation_invariant_error_deg": 0.22609621233137744, - "reverse_translation_m": 0.00371510987119075, - "reverse_rotation_deg": 0.04386474659625542, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "heldout_inlier_ratio": 0.7408722109533469, - "heldout_inlier_rmse_m": 0.1145103812359268, - "rotation_invariant_error_deg": 0.19254441231240094, - "reverse_translation_m": 0.0033854042879271646, - "reverse_rotation_deg": 0.04345206885157784, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 35, - "heldout_inlier_ratio": 0.8249047681597268, - "heldout_inlier_rmse_m": 0.10651397196801952, - "rotation_invariant_error_deg": 0.10135448011166659, - "reverse_translation_m": 0.014229552741777998, - "reverse_rotation_deg": 0.06789311177543367, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 34, - "heldout_inlier_ratio": 0.8265015479876161, - "heldout_inlier_rmse_m": 0.1079360614731508, - "rotation_invariant_error_deg": 0.048108712230231276, - "reverse_translation_m": 0.005517776656180037, - "reverse_rotation_deg": 0.04447304678975396, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "heldout_inlier_ratio": 0.7029487179487179, - "heldout_inlier_rmse_m": 0.11079043369762126, - "rotation_invariant_error_deg": 0.17528454363710466, - "reverse_translation_m": 0.0045321280438173584, - "reverse_rotation_deg": 0.02066446888667937, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "heldout_inlier_ratio": 0.612932138284251, - "heldout_inlier_rmse_m": 0.11677728789370431, - "rotation_invariant_error_deg": 0.20412533615306927, - "reverse_translation_m": 0.011704878383874686, - "reverse_rotation_deg": 0.04254924292122366, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 34, - "j": 35, - "heldout_inlier_ratio": 0.7198829665436968, - "heldout_inlier_rmse_m": 0.11381984857774002, - "rotation_invariant_error_deg": 0.12000431919748422, - "reverse_translation_m": 0.015242618456135898, - "reverse_rotation_deg": 0.1219677981121258, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "heldout_inlier_ratio": 0.6450260449752255, - "heldout_inlier_rmse_m": 0.11677131628998773, - "rotation_invariant_error_deg": 0.19260029035337567, - "reverse_translation_m": 0.0029445631740664846, - "reverse_rotation_deg": 0.0910859237401823, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 34, - "j": 37, - "heldout_inlier_ratio": 0.6870731404445548, - "heldout_inlier_rmse_m": 0.11846537329500156, - "rotation_invariant_error_deg": 0.282787508961146, - "reverse_translation_m": 0.013941395463696922, - "reverse_rotation_deg": 0.12307688004234886, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 35, - "j": 36, - "heldout_inlier_ratio": 0.811216429699842, - "heldout_inlier_rmse_m": 0.11156358795429076, - "rotation_invariant_error_deg": 0.02901618850874499, - "reverse_translation_m": 0.003966448406861189, - "reverse_rotation_deg": 0.11486278330291146, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "heldout_inlier_ratio": 0.6916945230136282, - "heldout_inlier_rmse_m": 0.12226449151266647, - "rotation_invariant_error_deg": 0.19917291850710628, - "reverse_translation_m": 0.012490325532322776, - "reverse_rotation_deg": 0.1588294259454204, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 36, - "j": 37, - "heldout_inlier_ratio": 0.6406009244992296, - "heldout_inlier_rmse_m": 0.123972843683949, - "rotation_invariant_error_deg": 0.09160881155707656, - "reverse_translation_m": 0.011995188628592031, - "reverse_rotation_deg": 0.19550165133048591, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - } - ] -} diff --git a/results/01_previous_two_batches/open3d_gicp/batch1_auxiliary_check.json b/results/01_previous_two_batches/open3d_gicp/batch1_auxiliary_check.json deleted file mode 100644 index ca03da5..0000000 --- a/results/01_previous_two_batches/open3d_gicp/batch1_auxiliary_check.json +++ /dev/null @@ -1,312 +0,0 @@ -{ - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": true, - "note": "No AX residual was used to select these pairs", - "stations": 38, - "metrics": { - "pairs": 41, - "translation_m": { - "rms": 0.06627076507951374, - "median": 0.047988641017293804, - "p90": 0.09181504914902948, - "p95": 0.11277678323253028, - "max": 0.15600463105844264 - }, - "rotation_deg": { - "rms": 1.0783402768758907, - "median": 0.7259689138952466, - "p90": 1.6809461304799602, - "p95": 1.7792880941356781, - "max": 1.856511169904947 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.023735072067512103, - "rotation_deg": 0.35856568622307705, - "i": 0, - "j": 1 - }, - { - "pair_index": 1, - "translation_m": 0.05526576799076716, - "rotation_deg": 0.688292682153714, - "i": 0, - "j": 3 - }, - { - "pair_index": 2, - "translation_m": 0.04806529792477384, - "rotation_deg": 1.7792880941356781, - "i": 1, - "j": 2 - }, - { - "pair_index": 3, - "translation_m": 0.02732889363320134, - "rotation_deg": 1.856511169904947, - "i": 2, - "j": 3 - }, - { - "pair_index": 4, - "translation_m": 0.03927257848059381, - "rotation_deg": 1.6809461304799602, - "i": 2, - "j": 5 - }, - { - "pair_index": 5, - "translation_m": 0.09000097958526627, - "rotation_deg": 0.6847419474141874, - "i": 3, - "j": 4 - }, - { - "pair_index": 6, - "translation_m": 0.03101397287067455, - "rotation_deg": 0.16914815750366516, - "i": 3, - "j": 5 - }, - { - "pair_index": 7, - "translation_m": 0.07754221345029244, - "rotation_deg": 0.7259689138952466, - "i": 4, - "j": 5 - }, - { - "pair_index": 8, - "translation_m": 0.03330333298983308, - "rotation_deg": 0.2953381460156314, - "i": 5, - "j": 6 - }, - { - "pair_index": 9, - "translation_m": 0.013926178859499422, - "rotation_deg": 1.0956547835384745, - "i": 6, - "j": 7 - }, - { - "pair_index": 10, - "translation_m": 0.040796788287758956, - "rotation_deg": 0.5732579539729787, - "i": 6, - "j": 9 - }, - { - "pair_index": 11, - "translation_m": 0.05468973725915344, - "rotation_deg": 1.0002199501064295, - "i": 11, - "j": 12 - }, - { - "pair_index": 12, - "translation_m": 0.06427358796963496, - "rotation_deg": 1.4794289625543822, - "i": 16, - "j": 17 - }, - { - "pair_index": 13, - "translation_m": 0.15600463105844264, - "rotation_deg": 1.480613890179137, - "i": 16, - "j": 18 - }, - { - "pair_index": 14, - "translation_m": 0.10022423249183152, - "rotation_deg": 0.4939634910387222, - "i": 17, - "j": 18 - }, - { - "pair_index": 15, - "translation_m": 0.11277678323253028, - "rotation_deg": 1.4534337020592556, - "i": 18, - "j": 19 - }, - { - "pair_index": 16, - "translation_m": 0.09181504914902948, - "rotation_deg": 0.5121047642461125, - "i": 18, - "j": 20 - }, - { - "pair_index": 17, - "translation_m": 0.07621294129483619, - "rotation_deg": 1.2114882514394736, - "i": 18, - "j": 21 - }, - { - "pair_index": 18, - "translation_m": 0.05057962673548217, - "rotation_deg": 1.7070235499578508, - "i": 19, - "j": 20 - }, - { - "pair_index": 19, - "translation_m": 0.028485843207444878, - "rotation_deg": 1.282910024621228, - "i": 20, - "j": 21 - }, - { - "pair_index": 20, - "translation_m": 0.047988641017293804, - "rotation_deg": 0.3479009355224502, - "i": 20, - "j": 22 - }, - { - "pair_index": 21, - "translation_m": 0.036673661370321194, - "rotation_deg": 0.7294078635231547, - "i": 20, - "j": 23 - }, - { - "pair_index": 22, - "translation_m": 0.053305241810354, - "rotation_deg": 1.5203537906970106, - "i": 21, - "j": 22 - }, - { - "pair_index": 23, - "translation_m": 0.06724337658756505, - "rotation_deg": 0.6388309960595039, - "i": 21, - "j": 24 - }, - { - "pair_index": 24, - "translation_m": 0.04395944502343888, - "rotation_deg": 0.532486384255132, - "i": 22, - "j": 23 - }, - { - "pair_index": 25, - "translation_m": 0.02014164497275169, - "rotation_deg": 1.454337113913715, - "i": 22, - "j": 24 - }, - { - "pair_index": 26, - "translation_m": 0.015070014725991494, - "rotation_deg": 1.3619366988381034, - "i": 23, - "j": 24 - }, - { - "pair_index": 27, - "translation_m": 0.04337448537472198, - "rotation_deg": 0.5946988587087709, - "i": 24, - "j": 25 - }, - { - "pair_index": 28, - "translation_m": 0.04609106556910267, - "rotation_deg": 0.8042445263370658, - "i": 24, - "j": 26 - }, - { - "pair_index": 29, - "translation_m": 0.08550650491731009, - "rotation_deg": 0.4123121681282486, - "i": 25, - "j": 26 - }, - { - "pair_index": 30, - "translation_m": 0.03526150890834157, - "rotation_deg": 1.4877458273245419, - "i": 27, - "j": 28 - }, - { - "pair_index": 31, - "translation_m": 0.04728048748001428, - "rotation_deg": 1.6462112767436325, - "i": 27, - "j": 29 - }, - { - "pair_index": 32, - "translation_m": 0.038221731232831464, - "rotation_deg": 0.32809158958487783, - "i": 28, - "j": 29 - }, - { - "pair_index": 33, - "translation_m": 0.08450868583143198, - "rotation_deg": 0.4200755376297717, - "i": 30, - "j": 31 - }, - { - "pair_index": 34, - "translation_m": 0.08626234893146881, - "rotation_deg": 0.4145763973148079, - "i": 30, - "j": 33 - }, - { - "pair_index": 35, - "translation_m": 0.031883992409525753, - "rotation_deg": 0.47209162292986384, - "i": 31, - "j": 33 - }, - { - "pair_index": 36, - "translation_m": 0.07512585318274038, - "rotation_deg": 0.4948719177387593, - "i": 33, - "j": 34 - }, - { - "pair_index": 37, - "translation_m": 0.1468426442855739, - "rotation_deg": 0.5255877510410011, - "i": 33, - "j": 35 - }, - { - "pair_index": 38, - "translation_m": 0.0854721649952596, - "rotation_deg": 0.7101299092541083, - "i": 34, - "j": 35 - }, - { - "pair_index": 39, - "translation_m": 0.03486824711848649, - "rotation_deg": 1.7800497000791062, - "i": 34, - "j": 37 - }, - { - "pair_index": 40, - "translation_m": 0.028519367999920175, - "rotation_deg": 1.540726633727796, - "i": 35, - "j": 36 - } - ] - } -} diff --git a/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2.json b/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2.json deleted file mode 100644 index 1634334..0000000 --- a/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2.json +++ /dev/null @@ -1,744 +0,0 @@ -{ - "schema_version": 2, - "success": true, - "message": "Both `ftol` and `xtol` termination conditions are 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.2962115049352554, - -0.0001653420733896053, - 0.7164468137861116 - ], - "rotation_rpy_deg_xyz": [ - -0.7022421146530834, - 1.3831306856730625, - -0.8286069697615047 - ], - "quaternion_xyzw": [ - -0.006040299739348631, - 0.012113565983787752, - -0.007156270443853885, - 0.9998827751749451 - ], - "matrix_4x4": [ - [ - 0.9996040986249817, - 0.014164523963697197, - 0.024310743983262467, - 1.2962115049352554 - ], - [ - -0.01445720224151504, - 0.9998246051447864, - 0.011905807424097893, - -0.0001653420733896053 - ], - [ - -0.02413783990927558, - -0.012252559240975732, - 0.9996335525964305, - 0.7164468137861116 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 38, - "pairs": 108, - "residuals": { - "pairs": 108, - "translation_m": { - "rms": 0.19743856479972394, - "median": 0.06046352611504703, - "p90": 0.21107717888307384, - "p95": 0.4320413132492668, - "max": 0.9185086085818974 - }, - "rotation_deg": { - "rms": 1.594164834809931, - "median": 0.9846062073478139, - "p90": 2.2895871608918337, - "p95": 2.7021815285034116, - "max": 5.449412955100641 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.07883616778657004, - "rotation_deg": 0.5080220774435835 - }, - { - "pair_index": 1, - "translation_m": 0.13193158825620543, - "rotation_deg": 0.4741606069012087 - }, - { - "pair_index": 2, - "translation_m": 0.11129387971109267, - "rotation_deg": 0.5206505897892112 - }, - { - "pair_index": 3, - "translation_m": 0.06037317704760375, - "rotation_deg": 0.4636666105342909 - }, - { - "pair_index": 4, - "translation_m": 0.0532377491787842, - "rotation_deg": 0.6385789459945687 - }, - { - "pair_index": 5, - "translation_m": 0.036086228084217256, - "rotation_deg": 0.7053466734460281 - }, - { - "pair_index": 6, - "translation_m": 0.024212071864605337, - "rotation_deg": 0.35966262441445085 - }, - { - "pair_index": 7, - "translation_m": 0.07843107284074759, - "rotation_deg": 0.9672771351659644 - }, - { - "pair_index": 8, - "translation_m": 0.1331135483643765, - "rotation_deg": 0.9356542123031394 - }, - { - "pair_index": 9, - "translation_m": 0.06287483417453568, - "rotation_deg": 0.8539179575478302 - }, - { - "pair_index": 10, - "translation_m": 0.09307074193602183, - "rotation_deg": 1.1452312070788857 - }, - { - "pair_index": 11, - "translation_m": 0.10534310615277773, - "rotation_deg": 1.2697416838407303 - }, - { - "pair_index": 12, - "translation_m": 0.034156566922473784, - "rotation_deg": 0.4470789762879368 - }, - { - "pair_index": 13, - "translation_m": 0.05706608980344394, - "rotation_deg": 1.4538259192907348 - }, - { - "pair_index": 14, - "translation_m": 0.21156185043155915, - "rotation_deg": 0.32326983959580347 - }, - { - "pair_index": 15, - "translation_m": 0.04366721285272495, - "rotation_deg": 1.1486889953780957 - }, - { - "pair_index": 16, - "translation_m": 0.19784063737858906, - "rotation_deg": 0.4945905742106831 - }, - { - "pair_index": 17, - "translation_m": 0.13271207797084064, - "rotation_deg": 0.8074538026104654 - }, - { - "pair_index": 18, - "translation_m": 0.13649995064331025, - "rotation_deg": 1.035099347913503 - }, - { - "pair_index": 19, - "translation_m": 0.058892470655748055, - "rotation_deg": 0.6808326191608242 - }, - { - "pair_index": 20, - "translation_m": 0.12809115411885974, - "rotation_deg": 0.8895134738281241 - }, - { - "pair_index": 21, - "translation_m": 0.07473485983007296, - "rotation_deg": 0.7244832869216128 - }, - { - "pair_index": 22, - "translation_m": 0.003615738521241208, - "rotation_deg": 0.6536825959057917 - }, - { - "pair_index": 23, - "translation_m": 0.06957198571596916, - "rotation_deg": 0.7883364856790823 - }, - { - "pair_index": 24, - "translation_m": 0.06578636179058665, - "rotation_deg": 0.09595187830987498 - }, - { - "pair_index": 25, - "translation_m": 0.11708949328304538, - "rotation_deg": 0.9037314334019761 - }, - { - "pair_index": 26, - "translation_m": 0.2785740172886443, - "rotation_deg": 1.2395284599701288 - }, - { - "pair_index": 27, - "translation_m": 0.054803484360171, - "rotation_deg": 0.9197207214648975 - }, - { - "pair_index": 28, - "translation_m": 0.2066140285757045, - "rotation_deg": 1.4700310072490443 - }, - { - "pair_index": 29, - "translation_m": 0.21086946250515157, - "rotation_deg": 1.0216432855984101 - }, - { - "pair_index": 30, - "translation_m": 0.16273991885860312, - "rotation_deg": 1.6658320411463268 - }, - { - "pair_index": 31, - "translation_m": 0.17536744938199297, - "rotation_deg": 1.603914654640798 - }, - { - "pair_index": 32, - "translation_m": 0.12486444755757231, - "rotation_deg": 1.72640237007742 - }, - { - "pair_index": 33, - "translation_m": 0.03629298593419621, - "rotation_deg": 0.7021350382463348 - }, - { - "pair_index": 34, - "translation_m": 0.04096591124737788, - "rotation_deg": 1.182229412077533 - }, - { - "pair_index": 35, - "translation_m": 0.023876028562682318, - "rotation_deg": 2.3067680414707423 - }, - { - "pair_index": 36, - "translation_m": 0.0232665744848516, - "rotation_deg": 0.45561721689220397 - }, - { - "pair_index": 37, - "translation_m": 0.0202215693688227, - "rotation_deg": 1.7396398605001189 - }, - { - "pair_index": 38, - "translation_m": 0.2386974208323925, - "rotation_deg": 0.3084186872525065 - }, - { - "pair_index": 39, - "translation_m": 0.0320417923623188, - "rotation_deg": 1.537812332531765 - }, - { - "pair_index": 40, - "translation_m": 0.22893456979179405, - "rotation_deg": 0.6120657430945021 - }, - { - "pair_index": 41, - "translation_m": 0.3264153842951392, - "rotation_deg": 0.5281733672424023 - }, - { - "pair_index": 42, - "translation_m": 0.1540882733017021, - "rotation_deg": 1.9432086107260433 - }, - { - "pair_index": 43, - "translation_m": 0.21054079914538157, - "rotation_deg": 1.2442015725741578 - }, - { - "pair_index": 44, - "translation_m": 0.48891681345533766, - "rotation_deg": 2.8273101876072357 - }, - { - "pair_index": 45, - "translation_m": 0.10733355603351397, - "rotation_deg": 0.8721227552809412 - }, - { - "pair_index": 46, - "translation_m": 0.9185086085818974, - "rotation_deg": 4.489220955656682 - }, - { - "pair_index": 47, - "translation_m": 0.7319199589340636, - "rotation_deg": 5.449412955100641 - }, - { - "pair_index": 48, - "translation_m": 0.8659475201606082, - "rotation_deg": 3.8214376146729045 - }, - { - "pair_index": 49, - "translation_m": 0.7210574374098978, - "rotation_deg": 4.561541716053782 - }, - { - "pair_index": 50, - "translation_m": 0.5570099786748203, - "rotation_deg": 5.373002500144395 - }, - { - "pair_index": 51, - "translation_m": 0.04582605589663051, - "rotation_deg": 0.6822468845946373 - }, - { - "pair_index": 52, - "translation_m": 0.036857756558338325, - "rotation_deg": 1.7515216368522777 - }, - { - "pair_index": 53, - "translation_m": 0.043496707068384696, - "rotation_deg": 1.7461098288880414 - }, - { - "pair_index": 54, - "translation_m": 0.045832318963813956, - "rotation_deg": 1.041278909174025 - }, - { - "pair_index": 55, - "translation_m": 0.060553875182490315, - "rotation_deg": 0.8052115259091664 - }, - { - "pair_index": 56, - "translation_m": 0.06652308069145153, - "rotation_deg": 0.9632642598400051 - }, - { - "pair_index": 57, - "translation_m": 0.035908234140899456, - "rotation_deg": 1.2689384623057567 - }, - { - "pair_index": 58, - "translation_m": 0.060880526853900836, - "rotation_deg": 0.5935557534854639 - }, - { - "pair_index": 59, - "translation_m": 0.11419626074713392, - "rotation_deg": 0.7130165148085522 - }, - { - "pair_index": 60, - "translation_m": 0.04265037619565028, - "rotation_deg": 0.699587177579278 - }, - { - "pair_index": 61, - "translation_m": 0.04378802459846447, - "rotation_deg": 0.675205047149443 - }, - { - "pair_index": 62, - "translation_m": 0.08344520239044273, - "rotation_deg": 1.3214027680911706 - }, - { - "pair_index": 63, - "translation_m": 0.017638868448433938, - "rotation_deg": 0.17533894669557326 - }, - { - "pair_index": 64, - "translation_m": 0.03489149886931174, - "rotation_deg": 1.664944154610128 - }, - { - "pair_index": 65, - "translation_m": 0.10079671035324393, - "rotation_deg": 0.6171025033257196 - }, - { - "pair_index": 66, - "translation_m": 0.014396578516872966, - "rotation_deg": 1.650080935912764 - }, - { - "pair_index": 67, - "translation_m": 0.06023554532048859, - "rotation_deg": 0.42594747696355045 - }, - { - "pair_index": 68, - "translation_m": 0.03699195896487648, - "rotation_deg": 1.2778861613746475 - }, - { - "pair_index": 69, - "translation_m": 0.046905032676790276, - "rotation_deg": 1.132463118089895 - }, - { - "pair_index": 70, - "translation_m": 0.070685940640895, - "rotation_deg": 0.6925680609090175 - }, - { - "pair_index": 71, - "translation_m": 0.05072278859454283, - "rotation_deg": 0.40553765157890925 - }, - { - "pair_index": 72, - "translation_m": 0.061114192405838416, - "rotation_deg": 0.8033058778952246 - }, - { - "pair_index": 73, - "translation_m": 0.12007843139860787, - "rotation_deg": 0.9239227811720148 - }, - { - "pair_index": 74, - "translation_m": 0.12118933148474953, - "rotation_deg": 1.305746559495919 - }, - { - "pair_index": 75, - "translation_m": 0.05055191131491414, - "rotation_deg": 0.20965439069314443 - }, - { - "pair_index": 76, - "translation_m": 0.08360132660274813, - "rotation_deg": 0.876573476333775 - }, - { - "pair_index": 77, - "translation_m": 0.02835721910581123, - "rotation_deg": 1.5894295378250647 - }, - { - "pair_index": 78, - "translation_m": 0.03908539475543364, - "rotation_deg": 0.8083289126351658 - }, - { - "pair_index": 79, - "translation_m": 0.054143804150054306, - "rotation_deg": 1.6541418156239664 - }, - { - "pair_index": 80, - "translation_m": 0.026283210691822913, - "rotation_deg": 1.6667348211605557 - }, - { - "pair_index": 81, - "translation_m": 0.089350850518513, - "rotation_deg": 2.2825286794384145 - }, - { - "pair_index": 82, - "translation_m": 0.03347579217967635, - "rotation_deg": 1.9977395380091536 - }, - { - "pair_index": 83, - "translation_m": 0.019000630740619542, - "rotation_deg": 1.5515794014919868 - }, - { - "pair_index": 84, - "translation_m": 0.04109198168971092, - "rotation_deg": 0.6855676498071515 - }, - { - "pair_index": 85, - "translation_m": 0.04412164134783469, - "rotation_deg": 0.6915721855798296 - }, - { - "pair_index": 86, - "translation_m": 0.11294515765470313, - "rotation_deg": 2.2385943138303417 - }, - { - "pair_index": 87, - "translation_m": 0.01925918248868863, - "rotation_deg": 1.0019352795296634 - }, - { - "pair_index": 88, - "translation_m": 0.07700662983793743, - "rotation_deg": 2.187099011126195 - }, - { - "pair_index": 89, - "translation_m": 0.081983290439235, - "rotation_deg": 1.2833572216410762 - }, - { - "pair_index": 90, - "translation_m": 0.07413447803071471, - "rotation_deg": 1.509039762712118 - }, - { - "pair_index": 91, - "translation_m": 0.05026833056909235, - "rotation_deg": 0.6540616669180302 - }, - { - "pair_index": 92, - "translation_m": 0.07040328963228819, - "rotation_deg": 1.1208457441248971 - }, - { - "pair_index": 93, - "translation_m": 0.035342214388759695, - "rotation_deg": 0.932859896131992 - }, - { - "pair_index": 94, - "translation_m": 0.09059341699612283, - "rotation_deg": 2.23170809346331 - }, - { - "pair_index": 95, - "translation_m": 0.0903976819000103, - "rotation_deg": 2.3060569509498126 - }, - { - "pair_index": 96, - "translation_m": 0.029370567781526302, - "rotation_deg": 1.2512304574145157 - }, - { - "pair_index": 97, - "translation_m": 0.031018252539194446, - "rotation_deg": 1.2538724028818724 - }, - { - "pair_index": 98, - "translation_m": 0.05078748646827035, - "rotation_deg": 0.3396814347935095 - }, - { - "pair_index": 99, - "translation_m": 0.024770901259540175, - "rotation_deg": 0.09062392685294303 - }, - { - "pair_index": 100, - "translation_m": 0.03340161795186317, - "rotation_deg": 1.0544497064860483 - }, - { - "pair_index": 101, - "translation_m": 0.032353919411514664, - "rotation_deg": 2.4697997330248893 - }, - { - "pair_index": 102, - "translation_m": 0.0369893920228258, - "rotation_deg": 0.9428098575535183 - }, - { - "pair_index": 103, - "translation_m": 0.03967084241987133, - "rotation_deg": 2.4057498894359104 - }, - { - "pair_index": 104, - "translation_m": 0.032499330822438305, - "rotation_deg": 0.5201344456818268 - }, - { - "pair_index": 105, - "translation_m": 0.020738575117572048, - "rotation_deg": 1.147380363634985 - }, - { - "pair_index": 106, - "translation_m": 0.02864934739022941, - "rotation_deg": 0.9393233353789158 - }, - { - "pair_index": 107, - "translation_m": 0.04427763743614998, - "rotation_deg": 2.333163177357132 - } - ] - } - }, - "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.004408386781524471, - 0.004767641769352496, - 0.005598290825790153 - ], - "rotation_deg": [ - 0.048493732410523904, - 0.046658283462926005, - 0.07519664546145975 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 7.050612320852161, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 643.4104764663608, - "success": true, - "translation_m": 3.912474170044392e-10, - "rotation_deg": 6.735629049437961e-10 - }, - { - "cost": 643.4104764663626, - "success": true, - "translation_m": 5.541272376488872e-09, - "rotation_deg": 8.145564755773614e-08 - }, - { - "cost": 643.4104764663621, - "success": true, - "translation_m": 5.7457948050995e-09, - "rotation_deg": 9.303346267795607e-08 - }, - { - "cost": 643.4104764663617, - "success": true, - "translation_m": 2.194969543097371e-09, - "rotation_deg": 6.831261261103626e-08 - }, - { - "cost": 643.4104764663606, - "success": true, - "translation_m": 0.0, - "rotation_deg": 0.0 - }, - { - "cost": 643.4104764663606, - "success": true, - "translation_m": 2.0328177429825194e-10, - "rotation_deg": 5.30535295392565e-10 - }, - { - "cost": 643.4104764663606, - "success": true, - "translation_m": 2.942069407882596e-10, - "rotation_deg": 1.1060405674229135e-09 - }, - { - "cost": 643.4104764663616, - "success": true, - "translation_m": 2.0219843122070147e-09, - "rotation_deg": 6.76470161118562e-08 - }, - { - "cost": 643.4104764663626, - "success": true, - "translation_m": 4.562054371593163e-09, - "rotation_deg": 1.0596545697409183e-07 - }, - { - "cost": 643.4104764663607, - "success": true, - "translation_m": 1.928078172154913e-10, - "rotation_deg": 2.1724633303911955e-09 - }, - { - "cost": 643.4104764663614, - "success": true, - "translation_m": 4.546336113588724e-09, - "rotation_deg": 6.943102831728965e-08 - }, - { - "cost": 643.4104764663606, - "success": true, - "translation_m": 2.3977413195330228e-09, - "rotation_deg": 3.302215565653965e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.0019183316339420184, - 0.0018458296498062193, - 0.0015077091479455522, - 0.06309617953577086, - 0.06679628584461805, - 0.059116801250773655 - ], - "p025": [ - 1.2931455727368442, - -0.0034690771097207083, - 0.7130935831011376, - -0.8251808751744363, - 1.2576102536763605, - -0.9269499764475692 - ], - "p975": [ - 1.3004042751519689, - 0.0031684595904240874, - 0.7192601795844623, - -0.5861986801138164, - 1.5316240168054431, - -0.7099716198219946 - ] - } -} diff --git a/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2_refined.json b/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2_refined.json deleted file mode 100644 index cdc3672..0000000 --- a/results/01_previous_two_batches/open3d_gicp/extrinsic_batch2_refined.json +++ /dev/null @@ -1,534 +0,0 @@ -{ - "schema_version": 2, - "success": true, - "message": "Both `ftol` and `xtol` termination conditions are 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.2978831677200011, - -0.0030997734098957433, - 0.7217892226151688 - ], - "rotation_rpy_deg_xyz": [ - -0.7572070226288585, - 1.1460424368859559, - -0.8797812288284186 - ], - "quaternion_xyzw": [ - -0.006530524361500762, - 0.01005115598038874, - -0.007610830022211968, - 0.9998991958099549 - ], - "matrix_4x4": [ - [ - 0.9996820990596618, - 0.015088846999329667, - 0.020199690985244836, - 1.2978831677200011 - ], - [ - -0.01535140427529437, - 0.9997988550358736, - 0.012906736835176902, - -0.0030997734098957433 - ], - [ - -0.020000880141759644, - -0.013212727393950824, - 0.9997126530300434, - 0.7217892226151688 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 38, - "pairs": 66, - "residuals": { - "pairs": 66, - "translation_m": { - "rms": 0.10017183831403174, - "median": 0.055359414994267414, - "p90": 0.15842638830193137, - "p95": 0.2228212283177476, - "max": 0.3308905173432371 - }, - "rotation_deg": { - "rms": 1.011529772202344, - "median": 0.80406471347537, - "p90": 1.4897684651925762, - "p95": 1.743501596940947, - "max": 2.0866296585079986 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.08037293687095128, - "rotation_deg": 0.5606213555410943 - }, - { - "pair_index": 1, - "translation_m": 0.13688783822315873, - "rotation_deg": 0.5385985764755513 - }, - { - "pair_index": 2, - "translation_m": 0.1161820533771873, - "rotation_deg": 0.6051501049087227 - }, - { - "pair_index": 3, - "translation_m": 0.06274731030725329, - "rotation_deg": 0.43240094308199595 - }, - { - "pair_index": 4, - "translation_m": 0.05401417992581746, - "rotation_deg": 0.5598851592535787 - }, - { - "pair_index": 5, - "translation_m": 0.031474943657373466, - "rotation_deg": 0.4777215600802768 - }, - { - "pair_index": 6, - "translation_m": 0.02358754528130127, - "rotation_deg": 0.31065781541529597 - }, - { - "pair_index": 7, - "translation_m": 0.07821720458579819, - "rotation_deg": 0.8327360477136897 - }, - { - "pair_index": 8, - "translation_m": 0.13242931760456017, - "rotation_deg": 0.7104180024890483 - }, - { - "pair_index": 9, - "translation_m": 0.06337205097891703, - "rotation_deg": 0.7783419276431949 - }, - { - "pair_index": 10, - "translation_m": 0.09374967709473093, - "rotation_deg": 1.0032646553341338 - }, - { - "pair_index": 11, - "translation_m": 0.03473040865260945, - "rotation_deg": 0.38999250019936094 - }, - { - "pair_index": 12, - "translation_m": 0.21059850723479812, - "rotation_deg": 0.3446682830121482 - }, - { - "pair_index": 13, - "translation_m": 0.19573146558983065, - "rotation_deg": 0.48095280922563605 - }, - { - "pair_index": 14, - "translation_m": 0.1323566970626505, - "rotation_deg": 0.7201707943590688 - }, - { - "pair_index": 15, - "translation_m": 0.12966351135913337, - "rotation_deg": 1.112776940821149 - }, - { - "pair_index": 16, - "translation_m": 0.05614712317985888, - "rotation_deg": 0.875368334260281 - }, - { - "pair_index": 17, - "translation_m": 0.07051356442391056, - "rotation_deg": 0.6787378054467239 - }, - { - "pair_index": 18, - "translation_m": 0.00234867626016906, - "rotation_deg": 0.6239120141422153 - }, - { - "pair_index": 19, - "translation_m": 0.06798198251653766, - "rotation_deg": 1.002748878489142 - }, - { - "pair_index": 20, - "translation_m": 0.06408705260318404, - "rotation_deg": 0.03962823745578253 - }, - { - "pair_index": 21, - "translation_m": 0.112944365872764, - "rotation_deg": 1.0217086690617905 - }, - { - "pair_index": 22, - "translation_m": 0.052992189070368054, - "rotation_deg": 0.9852776192856918 - }, - { - "pair_index": 23, - "translation_m": 0.15367415365164572, - "rotation_deg": 1.6994783049152902 - }, - { - "pair_index": 24, - "translation_m": 0.034245918976706625, - "rotation_deg": 0.6364964475716594 - }, - { - "pair_index": 25, - "translation_m": 0.032447856067877326, - "rotation_deg": 1.0563370884814496 - }, - { - "pair_index": 26, - "translation_m": 0.013423581617645036, - "rotation_deg": 2.0866296585079986 - }, - { - "pair_index": 27, - "translation_m": 0.020771076323520654, - "rotation_deg": 0.38738877042810915 - }, - { - "pair_index": 28, - "translation_m": 0.025006531842362605, - "rotation_deg": 1.52954100014841 - }, - { - "pair_index": 29, - "translation_m": 0.24776379251997158, - "rotation_deg": 0.5631330497861866 - }, - { - "pair_index": 30, - "translation_m": 0.03125984364955898, - "rotation_deg": 1.3670046215070957 - }, - { - "pair_index": 31, - "translation_m": 0.23303779095818136, - "rotation_deg": 0.6816682778063402 - }, - { - "pair_index": 32, - "translation_m": 0.3308905173432371, - "rotation_deg": 0.35773823775063585 - }, - { - "pair_index": 33, - "translation_m": 0.16317862295221702, - "rotation_deg": 1.883393614450365 - }, - { - "pair_index": 34, - "translation_m": 0.22689546867873073, - "rotation_deg": 1.1173958780054432 - }, - { - "pair_index": 35, - "translation_m": 0.11481327905632552, - "rotation_deg": 0.9531859192751095 - }, - { - "pair_index": 36, - "translation_m": 0.03799144229981835, - "rotation_deg": 0.7744523894118182 - }, - { - "pair_index": 37, - "translation_m": 0.05628293924136787, - "rotation_deg": 1.14782377649109 - }, - { - "pair_index": 38, - "translation_m": 0.044190715841938503, - "rotation_deg": 0.6522697817009423 - }, - { - "pair_index": 39, - "translation_m": 0.01566159386457093, - "rotation_deg": 0.21165082671261798 - }, - { - "pair_index": 40, - "translation_m": 0.025885925200718387, - "rotation_deg": 1.758176027616166 - }, - { - "pair_index": 41, - "translation_m": 0.05672466093666094, - "rotation_deg": 0.656889656854011 - }, - { - "pair_index": 42, - "translation_m": 0.04499649801025904, - "rotation_deg": 1.202397214867585 - }, - { - "pair_index": 43, - "translation_m": 0.05457170680867596, - "rotation_deg": 1.0831506943354967 - }, - { - "pair_index": 44, - "translation_m": 0.061259367696104086, - "rotation_deg": 0.4788495792916977 - }, - { - "pair_index": 45, - "translation_m": 0.11550019477035034, - "rotation_deg": 0.4484966984286178 - }, - { - "pair_index": 46, - "translation_m": 0.11728514823414202, - "rotation_deg": 0.829787499307545 - }, - { - "pair_index": 47, - "translation_m": 0.05724708891657523, - "rotation_deg": 0.13864261724965515 - }, - { - "pair_index": 48, - "translation_m": 0.08594624077085096, - "rotation_deg": 0.5654259879584598 - }, - { - "pair_index": 49, - "translation_m": 0.03620565055727226, - "rotation_deg": 0.7322933697368991 - }, - { - "pair_index": 50, - "translation_m": 0.04214151304995954, - "rotation_deg": 1.4499959302367427 - }, - { - "pair_index": 51, - "translation_m": 0.028423032063821733, - "rotation_deg": 1.4083884036448566 - }, - { - "pair_index": 52, - "translation_m": 0.07837351471415148, - "rotation_deg": 2.059047791320455 - }, - { - "pair_index": 53, - "translation_m": 0.028769288969574303, - "rotation_deg": 1.678230006332038 - }, - { - "pair_index": 54, - "translation_m": 0.017809796347028943, - "rotation_deg": 1.156650317229778 - }, - { - "pair_index": 55, - "translation_m": 0.016503937937620585, - "rotation_deg": 1.0883396698886323 - }, - { - "pair_index": 56, - "translation_m": 0.06654456279831698, - "rotation_deg": 1.4361320254246386 - }, - { - "pair_index": 57, - "translation_m": 0.047435323978454284, - "rotation_deg": 0.5969029690601318 - }, - { - "pair_index": 58, - "translation_m": 0.03126348405840702, - "rotation_deg": 1.1168540542357488 - }, - { - "pair_index": 59, - "translation_m": 0.02474086331243135, - "rotation_deg": 1.3807442010221649 - }, - { - "pair_index": 60, - "translation_m": 0.030093157854206205, - "rotation_deg": 1.4167630603035772 - }, - { - "pair_index": 61, - "translation_m": 0.0541740507536005, - "rotation_deg": 0.698365025436339 - }, - { - "pair_index": 62, - "translation_m": 0.022134680709029235, - "rotation_deg": 0.2658404010324305 - }, - { - "pair_index": 63, - "translation_m": 0.029045352917775814, - "rotation_deg": 1.1570185249880154 - }, - { - "pair_index": 64, - "translation_m": 0.027405495714480508, - "rotation_deg": 1.03451592246849 - }, - { - "pair_index": 65, - "translation_m": 0.026462755506179093, - "rotation_deg": 1.2477273813337815 - } - ] - } - }, - "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.004882663700530851, - 0.005223180397875539, - 0.004609821026450364 - ], - "rotation_deg": [ - 0.05337730845362286, - 0.05101978444118743, - 0.13461471349060455 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.280132943609949, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 257.9158465208353, - "success": true, - "translation_m": 1.5339146489710882e-09, - "rotation_deg": 8.769019455279312e-08 - }, - { - "cost": 257.915846520835, - "success": true, - "translation_m": 1.6096332607990603e-10, - "rotation_deg": 3.2573047951731743e-09 - }, - { - "cost": 257.915846520835, - "success": true, - "translation_m": 1.7670480374755598e-10, - "rotation_deg": 6.1834270102153095e-09 - }, - { - "cost": 257.915846520835, - "success": true, - "translation_m": 4.1405468581662865e-10, - "rotation_deg": 3.068020689667501e-08 - }, - { - "cost": 257.9158465208356, - "success": true, - "translation_m": 2.8335867565734006e-09, - "rotation_deg": 1.5660913277854904e-07 - }, - { - "cost": 257.915846520835, - "success": true, - "translation_m": 1.0113279249597898e-10, - "rotation_deg": 1.1726291770865867e-09 - }, - { - "cost": 257.91584652083503, - "success": true, - "translation_m": 8.073503715426879e-10, - "rotation_deg": 4.276975901573228e-08 - }, - { - "cost": 257.91584652083486, - "success": true, - "translation_m": 3.469446951953614e-18, - "rotation_deg": 0.0 - }, - { - "cost": 257.91584652083515, - "success": true, - "translation_m": 1.698393313088208e-09, - "rotation_deg": 8.683351386297902e-08 - }, - { - "cost": 257.91584652083503, - "success": true, - "translation_m": 1.831365187011624e-10, - "rotation_deg": 1.6896050804471163e-09 - }, - { - "cost": 257.91584652083503, - "success": true, - "translation_m": 1.2207922904627949e-09, - "rotation_deg": 2.6207051319974274e-08 - }, - { - "cost": 257.9158465208349, - "success": true, - "translation_m": 2.9844783853630704e-10, - "rotation_deg": 1.1466486750928911e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.0020832827985508263, - 0.002063603632322515, - 0.001427746471392659, - 0.07576290622767821, - 0.06304875844333606, - 0.07843172452171372 - ], - "p025": [ - 1.2941517658812944, - -0.0068139260683400035, - 0.7194879609149559, - -0.932759562453139, - 1.0361273609600192, - -1.0172648960899553 - ], - "p975": [ - 1.303011833178259, - 0.0009615093863316334, - 0.7242819230641808, - -0.6514715860744424, - 1.2471483979735007, - -0.7328998428204786 - ] - } -} diff --git a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary.npz b/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary.npz deleted file mode 100644 index 9fadba4..0000000 Binary files a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary.npz and /dev/null differ diff --git a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.npz b/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.npz deleted file mode 100644 index aaf663f..0000000 Binary files a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.npz and /dev/null differ diff --git a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.refinement.json b/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.refinement.json deleted file mode 100644 index c617999..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch1_auxiliary_refined.refinement.json +++ /dev/null @@ -1,1107 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 88, - "accepted_pairs": 36, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.7376764924448849, - "heldout_inlier_rmse_m": 0.11846276711125131, - "rotation_invariant_error_deg": 0.22129318835960987, - "reverse_translation_m": 0.007238562624113292, - "reverse_rotation_deg": 0.02790414903884654, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.617186536801874, - "heldout_inlier_rmse_m": 0.12801123590557925, - "rotation_invariant_error_deg": 0.05387521716778032, - "reverse_translation_m": 0.006865219918284302, - "reverse_rotation_deg": 0.20055597955733165, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.7186066691459031, - "heldout_inlier_rmse_m": 0.11701588647718943, - "rotation_invariant_error_deg": 0.6139428026653277, - "reverse_translation_m": 0.008227849157773135, - "reverse_rotation_deg": 0.05354665376691754, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "heldout_inlier_ratio": 0.7423043095866315, - "heldout_inlier_rmse_m": 0.11327867264180574, - "rotation_invariant_error_deg": 0.5153890144957902, - "reverse_translation_m": 0.01880830643908174, - "reverse_rotation_deg": 0.13698190350335646, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.8389134554643083, - "heldout_inlier_rmse_m": 0.10681097771213023, - "rotation_invariant_error_deg": 0.8200386048726926, - "reverse_translation_m": 0.0035146019341874887, - "reverse_rotation_deg": 0.1349785173147079, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 1, - "j": 4, - "heldout_inlier_ratio": 0.88, - "heldout_inlier_rmse_m": 0.10289486740770283, - "rotation_invariant_error_deg": 1.4021993289498695, - "reverse_translation_m": 0.006064649004018339, - "reverse_rotation_deg": 0.061683233541617866, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.795020120724346, - "heldout_inlier_rmse_m": 0.10968948046836192, - "rotation_invariant_error_deg": 0.39800315778882833, - "reverse_translation_m": 0.006456546110122383, - "reverse_rotation_deg": 0.030970536985363332, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.7190493965409979, - "heldout_inlier_rmse_m": 0.11680954298455397, - "rotation_invariant_error_deg": 1.019325932632924, - "reverse_translation_m": 0.005632827193528356, - "reverse_rotation_deg": 0.03284052493715785, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.7598566308243727, - "heldout_inlier_rmse_m": 0.11774293624986373, - "rotation_invariant_error_deg": 0.35894295476261817, - "reverse_translation_m": 0.028141707120452414, - "reverse_rotation_deg": 0.19962462817569399, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.83898411109721, - "heldout_inlier_rmse_m": 0.10512726552504312, - "rotation_invariant_error_deg": 0.5611079985906926, - "reverse_translation_m": 0.006186049607122224, - "reverse_rotation_deg": 0.016880074405568043, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.7968186901951038, - "heldout_inlier_rmse_m": 0.11623997504357782, - "rotation_invariant_error_deg": 0.09995299705659022, - "reverse_translation_m": 0.021983524103315014, - "reverse_rotation_deg": 0.3960603757299183, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.6568381430363864, - "heldout_inlier_rmse_m": 0.12435814704811046, - "rotation_invariant_error_deg": 0.3065609497310362, - "reverse_translation_m": 0.008738020425158864, - "reverse_rotation_deg": 0.1291569973379011, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.7543039842597147, - "heldout_inlier_rmse_m": 0.11308907219490882, - "rotation_invariant_error_deg": 0.6735451567644475, - "reverse_translation_m": 0.002243469564109645, - "reverse_rotation_deg": 0.06843841908142442, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6218497827436374, - "heldout_inlier_rmse_m": 0.12814112793605542, - "rotation_invariant_error_deg": 0.8824124946213914, - "reverse_translation_m": 0.01600824572236542, - "reverse_rotation_deg": 0.4490447249637784, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.6169457128361238, - "heldout_inlier_rmse_m": 0.13205154815512993, - "rotation_invariant_error_deg": 0.6483931514944921, - "reverse_translation_m": 0.019160428104594212, - "reverse_rotation_deg": 0.2888349968548246, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.7372055740535208, - "heldout_inlier_rmse_m": 0.1175976253407229, - "rotation_invariant_error_deg": 0.2042317968981191, - "reverse_translation_m": 0.013833903611932107, - "reverse_rotation_deg": 0.01952771029395653, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.6841773746535651, - "heldout_inlier_rmse_m": 0.11964187966504931, - "rotation_invariant_error_deg": 0.021215900847408875, - "reverse_translation_m": 0.003240486196092054, - "reverse_rotation_deg": 0.04738439683023512, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.6521066412758867, - "heldout_inlier_rmse_m": 0.12472719695199193, - "rotation_invariant_error_deg": 0.10985986013008642, - "reverse_translation_m": 0.0278691016568626, - "reverse_rotation_deg": 0.41056933218195657, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.7538481109273629, - "heldout_inlier_rmse_m": 0.11470554120698542, - "rotation_invariant_error_deg": 0.22461269590162658, - "reverse_translation_m": 0.03433121044907878, - "reverse_rotation_deg": 0.14981218442224864, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.683003003003003, - "heldout_inlier_rmse_m": 0.11564979549315224, - "rotation_invariant_error_deg": 0.2949107500817263, - "reverse_translation_m": 0.008147035817338538, - "reverse_rotation_deg": 0.038229943243018406, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 9, - "heldout_inlier_ratio": 0.7360264227642277, - "heldout_inlier_rmse_m": 0.11829700338913093, - "rotation_invariant_error_deg": 0.31492391923465846, - "reverse_translation_m": 0.003942462178993821, - "reverse_rotation_deg": 0.004948404195791413, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.6644591611479028, - "heldout_inlier_rmse_m": 0.12091344193997677, - "rotation_invariant_error_deg": 0.12875763082670488, - "reverse_translation_m": 0.010087854632047892, - "reverse_rotation_deg": 0.1144705976875931, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 10, - "heldout_inlier_ratio": 0.8421725239616613, - "heldout_inlier_rmse_m": 0.10512064341715703, - "rotation_invariant_error_deg": 1.533012022126627, - "reverse_translation_m": 0.00590396821278501, - "reverse_rotation_deg": 0.011716048666689089, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.5915068162625166, - "heldout_inlier_rmse_m": 0.1229044134151169, - "rotation_invariant_error_deg": 1.372500196514551, - "reverse_translation_m": 0.008997663249148741, - "reverse_rotation_deg": 0.15439288797351725, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.5969882593159775, - "heldout_inlier_rmse_m": 0.11948988234049264, - "rotation_invariant_error_deg": 1.3666033895688727, - "reverse_translation_m": 0.0030407162313759195, - "reverse_rotation_deg": 0.04107484998318919, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.593742114559677, - "heldout_inlier_rmse_m": 0.12239484647700946, - "rotation_invariant_error_deg": 0.5873690241468097, - "reverse_translation_m": 0.035258275490363276, - "reverse_rotation_deg": 0.11274694382482037, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.6153363453815262, - "heldout_inlier_rmse_m": 0.12504774785186165, - "rotation_invariant_error_deg": 1.7657912052702152, - "reverse_translation_m": 0.0752860327247449, - "reverse_rotation_deg": 0.25939502405614967, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant", - "forward_reverse_translation" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.5888198757763975, - "heldout_inlier_rmse_m": 0.12435475144629402, - "rotation_invariant_error_deg": 2.816301517367729, - "reverse_translation_m": 0.008996147539897087, - "reverse_rotation_deg": 0.2187503499467401, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.5523974295600593, - "heldout_inlier_rmse_m": 0.12600876663407296, - "rotation_invariant_error_deg": 1.6197354168686005, - "reverse_translation_m": 0.0067913142930030295, - "reverse_rotation_deg": 0.19210976651930364, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.48622589531680444, - "heldout_inlier_rmse_m": 0.12387372192061825, - "rotation_invariant_error_deg": 2.7014501288745407, - "reverse_translation_m": 0.010457065237222635, - "reverse_rotation_deg": 0.051939983599844905, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.8081153752138841, - "heldout_inlier_rmse_m": 0.09827968392237502, - "rotation_invariant_error_deg": 0.34336809239488275, - "reverse_translation_m": 0.003170825002365958, - "reverse_rotation_deg": 0.052994059649638055, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.4904655770183259, - "heldout_inlier_rmse_m": 0.13065086109778945, - "rotation_invariant_error_deg": 0.8681618692259718, - "reverse_translation_m": 0.03026165336674197, - "reverse_rotation_deg": 0.022229096602302635, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.5502994743918836, - "heldout_inlier_rmse_m": 0.13363854913882675, - "rotation_invariant_error_deg": 1.9642842139933663, - "reverse_translation_m": 0.012728663920096705, - "reverse_rotation_deg": 0.13777836936248603, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.5394185760039418, - "heldout_inlier_rmse_m": 0.1291861812905223, - "rotation_invariant_error_deg": 0.23856414168935203, - "reverse_translation_m": 0.016569656651710556, - "reverse_rotation_deg": 0.06971243680146068, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.5838501763346711, - "heldout_inlier_rmse_m": 0.13149007038687927, - "rotation_invariant_error_deg": 2.406021322673112, - "reverse_translation_m": 0.016475747103725697, - "reverse_rotation_deg": 0.027479170527625274, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.6685967722064802, - "heldout_inlier_rmse_m": 0.11944947118678222, - "rotation_invariant_error_deg": 3.100556336011195, - "reverse_translation_m": 0.00889966253307221, - "reverse_rotation_deg": 0.1868503363813343, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.6380833851897947, - "heldout_inlier_rmse_m": 0.12132550246856395, - "rotation_invariant_error_deg": 1.7572195819347076, - "reverse_translation_m": 0.011310526444604854, - "reverse_rotation_deg": 0.11618951108877962, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.515650129902264, - "heldout_inlier_rmse_m": 0.1258655742770286, - "rotation_invariant_error_deg": 2.611164330468249, - "reverse_translation_m": 0.019790578845351906, - "reverse_rotation_deg": 0.2492103704468241, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.6016802569804793, - "heldout_inlier_rmse_m": 0.12195151942370595, - "rotation_invariant_error_deg": 1.8287537251768642, - "reverse_translation_m": 0.01939980613812204, - "reverse_rotation_deg": 0.1992615163030762, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.4590676165479315, - "heldout_inlier_rmse_m": 0.13331101566670972, - "rotation_invariant_error_deg": 1.063713413194106, - "reverse_translation_m": 0.03193705319987942, - "reverse_rotation_deg": 0.25820325147713563, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.5389415876185721, - "heldout_inlier_rmse_m": 0.1297159188720241, - "rotation_invariant_error_deg": 0.2970277425809975, - "reverse_translation_m": 0.007152603768137945, - "reverse_rotation_deg": 0.01099978555369691, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.7229415461973602, - "heldout_inlier_rmse_m": 0.10903876418375444, - "rotation_invariant_error_deg": 0.5676723399175714, - "reverse_translation_m": 0.004743603748938733, - "reverse_rotation_deg": 0.03110066538977425, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "heldout_inlier_ratio": 0.624375, - "heldout_inlier_rmse_m": 0.11606003815798548, - "rotation_invariant_error_deg": 0.6904622746451992, - "reverse_translation_m": 0.00942822069733503, - "reverse_rotation_deg": 0.10349184268425643, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.8035782747603833, - "heldout_inlier_rmse_m": 0.11258525838778834, - "rotation_invariant_error_deg": 0.09547136626898833, - "reverse_translation_m": 0.04456291633933312, - "reverse_rotation_deg": 0.40754887525204303, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.667207589564349, - "heldout_inlier_rmse_m": 0.1151980232980854, - "rotation_invariant_error_deg": 0.1944742305347944, - "reverse_translation_m": 0.002550382605456025, - "reverse_rotation_deg": 0.05599236133477508, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 20, - "heldout_inlier_ratio": 0.6696552595024624, - "heldout_inlier_rmse_m": 0.11181113630432839, - "rotation_invariant_error_deg": 0.2612547291574856, - "reverse_translation_m": 0.009851652453759501, - "reverse_rotation_deg": 0.030403861001117326, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.7803049555273189, - "heldout_inlier_rmse_m": 0.10890373850857962, - "rotation_invariant_error_deg": 0.1051307780703894, - "reverse_translation_m": 0.0027074586252039488, - "reverse_rotation_deg": 0.03345524421318835, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "heldout_inlier_ratio": 0.7890203137053227, - "heldout_inlier_rmse_m": 0.110891959946164, - "rotation_invariant_error_deg": 0.14242757521709848, - "reverse_translation_m": 0.07641393239305394, - "reverse_rotation_deg": 0.480643469622101, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 18, - "j": 21, - "heldout_inlier_ratio": 0.7686106562539362, - "heldout_inlier_rmse_m": 0.1151576675189467, - "rotation_invariant_error_deg": 0.5355548047097614, - "reverse_translation_m": 0.012325022302827005, - "reverse_rotation_deg": 0.06184414805686676, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "heldout_inlier_ratio": 0.6599384615384616, - "heldout_inlier_rmse_m": 0.1100348641166372, - "rotation_invariant_error_deg": 0.4312561690399832, - "reverse_translation_m": 0.032753113036640115, - "reverse_rotation_deg": 0.1570816751009414, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 22, - "heldout_inlier_ratio": 0.6354319180087847, - "heldout_inlier_rmse_m": 0.11655958277402616, - "rotation_invariant_error_deg": 0.07883692056142877, - "reverse_translation_m": 0.011678083327496752, - "reverse_rotation_deg": 0.14115606360994692, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.8091622059006598, - "heldout_inlier_rmse_m": 0.10860060068735904, - "rotation_invariant_error_deg": 0.41475298745175593, - "reverse_translation_m": 0.004342811149796408, - "reverse_rotation_deg": 0.43079835067471983, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.7075518262586377, - "heldout_inlier_rmse_m": 0.11619246575360609, - "rotation_invariant_error_deg": 0.02899683656265495, - "reverse_translation_m": 0.03233653011234762, - "reverse_rotation_deg": 0.3501326921447133, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.7127672722778395, - "heldout_inlier_rmse_m": 0.11187552234677736, - "rotation_invariant_error_deg": 0.458954798970467, - "reverse_translation_m": 0.0036477332397017036, - "reverse_rotation_deg": 0.03588537530780425, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7451905626134301, - "heldout_inlier_rmse_m": 0.11103160300292489, - "rotation_invariant_error_deg": 0.3376592434798411, - "reverse_translation_m": 0.007025231148999399, - "reverse_rotation_deg": 0.031656114821116355, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.7537566650508968, - "heldout_inlier_rmse_m": 0.1091762180475198, - "rotation_invariant_error_deg": 0.8484840788940673, - "reverse_translation_m": 0.0026262958914527778, - "reverse_rotation_deg": 0.05939834892732321, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.7108181370133071, - "heldout_inlier_rmse_m": 0.1147630411233105, - "rotation_invariant_error_deg": 0.5773226964492437, - "reverse_translation_m": 0.002611195084459223, - "reverse_rotation_deg": 0.042823121286843194, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.8809323561215908, - "heldout_inlier_rmse_m": 0.09065520084082093, - "rotation_invariant_error_deg": 0.48878987709370847, - "reverse_translation_m": 0.00074030291113835, - "reverse_rotation_deg": 0.005760006892562891, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.7459386832783681, - "heldout_inlier_rmse_m": 0.1116686389188481, - "rotation_invariant_error_deg": 0.18333668895100175, - "reverse_translation_m": 0.010212372381123916, - "reverse_rotation_deg": 0.01461127103474581, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.6250595521676989, - "heldout_inlier_rmse_m": 0.10935727133461083, - "rotation_invariant_error_deg": 0.1445410856306779, - "reverse_translation_m": 0.013489723519689117, - "reverse_rotation_deg": 0.0723917800582207, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.7936138977244923, - "heldout_inlier_rmse_m": 0.11107653584131949, - "rotation_invariant_error_deg": 0.28931844309565236, - "reverse_translation_m": 0.008437497431588122, - "reverse_rotation_deg": 0.2765568737620497, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.6337826553739712, - "heldout_inlier_rmse_m": 0.11196536842375276, - "rotation_invariant_error_deg": 0.34887197704915707, - "reverse_translation_m": 0.02359951283541323, - "reverse_rotation_deg": 0.10308564406068685, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6073053892215569, - "heldout_inlier_rmse_m": 0.11004156310392302, - "rotation_invariant_error_deg": 0.02254863953950803, - "reverse_translation_m": 0.013062761031411258, - "reverse_rotation_deg": 0.0548185753269731, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.7898629804777495, - "heldout_inlier_rmse_m": 0.11080878069613129, - "rotation_invariant_error_deg": 0.04235638050610646, - "reverse_translation_m": 0.024355899665769485, - "reverse_rotation_deg": 0.10833606018329535, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.7515217920623326, - "heldout_inlier_rmse_m": 0.10216449744519186, - "rotation_invariant_error_deg": 0.31382903080792346, - "reverse_translation_m": 0.010967953426658109, - "reverse_rotation_deg": 0.044641472084512177, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.6259589210591437, - "heldout_inlier_rmse_m": 0.11074683701330018, - "rotation_invariant_error_deg": 0.027078877546159674, - "reverse_translation_m": 0.04374270593226806, - "reverse_rotation_deg": 0.34168251600562055, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.8273774189718628, - "heldout_inlier_rmse_m": 0.10613402567174812, - "rotation_invariant_error_deg": 0.3634949100457163, - "reverse_translation_m": 0.018863132797671257, - "reverse_rotation_deg": 0.12251687299132978, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.6236883367506936, - "heldout_inlier_rmse_m": 0.11275084173352168, - "rotation_invariant_error_deg": 0.07173503222149691, - "reverse_translation_m": 0.005757137825848521, - "reverse_rotation_deg": 0.2558617834036415, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.6585129571324776, - "heldout_inlier_rmse_m": 0.10848902314415616, - "rotation_invariant_error_deg": 0.3200021847104608, - "reverse_translation_m": 0.002959097196576797, - "reverse_rotation_deg": 0.043581628031778105, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.6648410525062507, - "heldout_inlier_rmse_m": 0.11120026543063653, - "rotation_invariant_error_deg": 0.4424633543158478, - "reverse_translation_m": 0.012512803173543077, - "reverse_rotation_deg": 0.11122589391716618, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.7954517962985364, - "heldout_inlier_rmse_m": 0.10154002419986238, - "rotation_invariant_error_deg": 0.18277895623498353, - "reverse_translation_m": 0.019135551099374308, - "reverse_rotation_deg": 0.08227568287606397, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7446499818643453, - "heldout_inlier_rmse_m": 0.1104935519181424, - "rotation_invariant_error_deg": 0.05019706664897683, - "reverse_translation_m": 0.015390416284740782, - "reverse_rotation_deg": 0.08645102756020058, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.8317879220161674, - "heldout_inlier_rmse_m": 0.10401467258245657, - "rotation_invariant_error_deg": 0.2248090151088249, - "reverse_translation_m": 0.007126704551442278, - "reverse_rotation_deg": 0.059447117802805614, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "heldout_inlier_ratio": 0.540360873694207, - "heldout_inlier_rmse_m": 0.1217315596532435, - "rotation_invariant_error_deg": 0.07684932677659617, - "reverse_translation_m": 0.02476143939627759, - "reverse_rotation_deg": 0.2783665026489561, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 31, - "heldout_inlier_ratio": 0.5051186318198242, - "heldout_inlier_rmse_m": 0.12667907013046822, - "rotation_invariant_error_deg": 0.24795246285512462, - "reverse_translation_m": 0.01381623315543165, - "reverse_rotation_deg": 0.08866229443960012, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 29, - "j": 31, - "heldout_inlier_ratio": 0.49440231130371975, - "heldout_inlier_rmse_m": 0.12866710903574613, - "rotation_invariant_error_deg": 0.010020066816991857, - "reverse_translation_m": 0.047123741889749056, - "reverse_rotation_deg": 0.2295904679982487, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.8480586608967424, - "heldout_inlier_rmse_m": 0.09667505139943416, - "rotation_invariant_error_deg": 0.36709925472124993, - "reverse_translation_m": 0.01573204986385798, - "reverse_rotation_deg": 0.04061482397026774, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.867680517303317, - "heldout_inlier_rmse_m": 0.0986734040048058, - "rotation_invariant_error_deg": 2.641534885952595, - "reverse_translation_m": 0.002023273028745447, - "reverse_rotation_deg": 0.014811950864385802, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 30, - "j": 33, - "heldout_inlier_ratio": 0.7995722941665676, - "heldout_inlier_rmse_m": 0.10006346131537393, - "rotation_invariant_error_deg": 0.04190651915672561, - "reverse_translation_m": 0.00887908049317058, - "reverse_rotation_deg": 0.048438711468841336, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.8486026731470231, - "heldout_inlier_rmse_m": 0.09714101002609693, - "rotation_invariant_error_deg": 2.999438414097348, - "reverse_translation_m": 0.012921368358244189, - "reverse_rotation_deg": 0.05809273577687571, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 32, - "j": 33, - "heldout_inlier_ratio": 0.8592699327569645, - "heldout_inlier_rmse_m": 0.08972486966187442, - "rotation_invariant_error_deg": 2.5869888325237724, - "reverse_translation_m": 0.0035725430520846596, - "reverse_rotation_deg": 0.009168450597030125, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 33, - "j": 35, - "heldout_inlier_ratio": 0.8329018592610026, - "heldout_inlier_rmse_m": 0.09179860947142506, - "rotation_invariant_error_deg": 0.5315276710855841, - "reverse_translation_m": 0.0072384331805243046, - "reverse_rotation_deg": 0.028209706778456432, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "heldout_inlier_ratio": 0.760797342192691, - "heldout_inlier_rmse_m": 0.09861359027653524, - "rotation_invariant_error_deg": 1.069142055809408, - "reverse_translation_m": 0.0022735557932631, - "reverse_rotation_deg": 0.12221117701824208, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 34, - "j": 35, - "heldout_inlier_ratio": 0.8649093904448105, - "heldout_inlier_rmse_m": 0.0788491357224537, - "rotation_invariant_error_deg": 0.5291819610871329, - "reverse_translation_m": 0.0032110784907267375, - "reverse_rotation_deg": 0.015379666997505564, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "heldout_inlier_ratio": 0.7729789590254706, - "heldout_inlier_rmse_m": 0.09845381444357724, - "rotation_invariant_error_deg": 1.1023555366274849, - "reverse_translation_m": 0.011794412591703963, - "reverse_rotation_deg": 0.006135949966801849, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 34, - "j": 37, - "heldout_inlier_ratio": 0.722881252293017, - "heldout_inlier_rmse_m": 0.09759501600127507, - "rotation_invariant_error_deg": 0.6297249481365981, - "reverse_translation_m": 0.024742240312777743, - "reverse_rotation_deg": 0.08718512569927171, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "heldout_inlier_ratio": 0.7695298262665533, - "heldout_inlier_rmse_m": 0.09495386680108024, - "rotation_invariant_error_deg": 0.5500753965157372, - "reverse_translation_m": 0.006644101856716534, - "reverse_rotation_deg": 0.038610475450088305, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 36, - "j": 37, - "heldout_inlier_ratio": 0.8785082174462705, - "heldout_inlier_rmse_m": 0.08834636280188386, - "rotation_invariant_error_deg": 1.761508789593698, - "reverse_translation_m": 0.003787237363253161, - "reverse_rotation_deg": 0.027331592166342466, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - } - ] -} diff --git a/results/01_previous_two_batches/small_gicp/B_batch1_quality.csv b/results/01_previous_two_batches/small_gicp/B_batch1_quality.csv deleted file mode 100644 index 39a10cb..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch1_quality.csv +++ /dev/null @@ -1,109 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,4.069460063439237,24.612641616688823,0.7376764924448849,0.11846276711125131,6,14.186383674198092,0.007238562624113292,0.02790414903884654,1.0,True, -0,2,8.883155687691525,14.186041609026283,0.617186536801874,0.12801123590557925,6,36.79061260583155,0.006865219918284302,0.20055597955733165,1.0,True, -0,3,5.800196618465403,50.885974946353855,0.7186066691459031,0.11701588647718943,6,18.363958192984455,0.008227849157773135,0.05354665376691754,1.0,True, -1,2,4.892046307546544,10.426600007662538,0.7423043095866315,0.11327867264180574,6,26.05793878332379,0.01880830643908174,0.13698190350335646,1.0,True, -1,3,1.7315947839093804,26.273333329665036,0.8389134554643083,0.10681097771213023,6,14.956194090958816,0.0035146019341874887,0.1349785173147079,1.0,True, -1,4,1.6946255625760025,60.40345832959281,0.88,0.10289486740770283,6,11.829281279209892,0.006064649004018339,0.061683233541617866,1.0,True, -2,3,3.2805755806518446,36.69993333732758,0.795020120724346,0.10968948046836192,6,23.96630628312886,0.006456546110122383,0.030970536985363332,1.0,True, -2,4,4.866335020594746,70.83005833725535,0.7190493965409979,0.11680954298455397,6,23.730154915082874,0.005632827193528356,0.03284052493715785,1.0,True, -2,5,1.8274406190287722,30.448549979291712,0.7598566308243727,0.11774293624986373,6,16.599379025063065,0.028141707120452414,0.19962462817569399,1.0,True, -3,4,1.75881263274858,34.13012499992777,0.83898411109721,0.10512726552504312,6,15.664666117555983,0.006186049607122224,0.016880074405568043,1.0,True, -3,5,2.1020200425132134,67.14848331661929,0.7968186901951038,0.11623997504357782,6,18.1548400244513,0.021983524103315014,0.3960603757299183,1.0,True, -3,6,5.791805311102367,61.163322289150074,0.6568381430363864,0.12435814704811046,6,25.0151910725651,0.008738020425158864,0.1291569973379011,1.0,True, -4,5,3.30592832159088,101.27860831654709,0.7543039842597147,0.11308907219490882,6,19.690455732375476,0.002243469564109645,0.06843841908142442,1.0,True, -4,6,6.453995240105232,95.29344728907782,0.6218497827436374,0.12814112793605542,6,41.84651093530334,0.01600824572236542,0.4490447249637784,1.0,True, -4,7,9.537609568572432,26.32130681988008,0.6169457128361238,0.13205154815512993,6,36.92786505190044,0.019160428104594212,0.2888349968548246,1.0,True, -5,6,3.7769167422851373,5.985161027469212,0.7372055740535208,0.1175976253407229,6,19.32269960027907,0.013833903611932107,0.01952771029395653,1.0,True, -5,7,6.565348405821576,74.95730149666699,0.6841773746535651,0.11964187966504931,6,27.33180748081407,0.003240486196092054,0.04738439683023512,1.0,True, -5,8,6.3343271669452825,107.99940292217995,0.6521066412758867,0.12472719695199193,6,19.156993592870748,0.0278691016568626,0.41056933218195657,1.0,True, -6,7,3.1558607172566147,68.97214046919777,0.7538481109273629,0.11470554120698542,6,17.160170663404163,0.03433121044907878,0.14981218442224864,1.0,True, -6,8,3.3979014114419868,102.01424189471071,0.683003003003003,0.11564979549315224,6,20.447019845630425,0.008147035817338538,0.038229943243018406,1.0,True, -6,9,0.28270347875173524,124.11602215258995,0.7360264227642277,0.11829700338913093,6,18.21588471622476,0.003942462178993821,0.004948404195791413,1.0,True, -7,8,4.78580085090425,33.04210142551296,0.6644591611479028,0.12091344193997677,6,22.65051252921267,0.010087854632047892,0.1144705976875931,1.0,True, -7,9,2.876695741106431,166.91183737821345,0.6157641864692897,0.12124276796057824,6,31.889839980753695,2.858085971145254,5.202834749913653,1.0,False,forward_reverse_translation;forward_reverse_rotation -7,10,3.5227760858025783,151.5297683494061,0.8421725239616613,0.10512064341715703,6,18.208137447441548,0.00590396821278501,0.011716048666689089,1.0,True, -8,9,3.469611483011297,133.86973595269956,0.5997550520514391,0.12251997518546373,6,26.58434328826198,0.1455308769088698,0.6888512968600221,1.0,False,forward_reverse_translation;forward_reverse_rotation -8,10,8.226583602288494,175.42813022508852,0.5915068162625166,0.1229044134151169,6,28.111420003057543,0.008997663249148741,0.15439288797351725,1.0,True, -8,11,1.865267488778983,173.7180803410843,0.6836137963957513,0.11276660610764273,6,37.61742547586071,0.1113060196402131,0.53316971567076,1.0,False,forward_reverse_translation;forward_reverse_rotation -9,10,5.488028285806731,41.558394272381754,0.5969882593159775,0.11948988234049264,6,38.89573848099908,0.0030407162313759195,0.04107484998318919,1.0,True, -9,11,4.718056434111957,39.84834438838189,0.593742114559677,0.12239484647700946,6,46.81089854115947,0.035258275490363276,0.11274694382482037,1.0,True, -9,12,4.0664516687652705,11.300244475855449,0.6153363453815262,0.12504774785186165,6,23.277303065116303,0.0752860327247449,0.25939502405614967,1.0,True, -10,11,8.48963239412477,1.7100498839998592,0.5888198757763975,0.12435475144629402,6,51.68982317778118,0.008996147539897087,0.2187503499467401,1.0,True, -10,12,7.8510898708654135,30.258149796526293,0.5523974295600593,0.12600876663407296,6,24.040230371790127,0.0067913142930030295,0.19210976651930364,1.0,True, -10,13,7.303425556850936,93.89697482620899,0.48622589531680444,0.12387372192061825,6,40.15734453396082,0.010457065237222635,0.051939983599844905,1.0,True, -11,12,0.684356309096518,28.54809991252644,0.8081153752138841,0.09827968392237502,6,14.074429682972724,0.003170825002365958,0.052994059649638055,1.0,True, -11,13,4.983180422136547,92.18692494220912,0.4904655770183259,0.13065086109778945,6,59.94917005604024,0.03026165336674197,0.022229096602302635,1.0,True, -11,14,7.513058208926106,116.17598776756182,0.5502994743918836,0.13363854913882675,6,76.59552817138297,0.012728663920096705,0.13777836936248603,1.0,True, -12,13,4.470221622128888,63.638825029682685,0.5394185760039418,0.1291861812905223,6,40.18929295270992,0.016569656651710556,0.06971243680146068,1.0,True, -12,14,7.042432348069883,87.62788785503537,0.5838501763346711,0.13149007038687927,6,46.68047224389145,0.016475747103725697,0.027479170527625274,1.0,True, -12,15,9.425648786798952,64.11974003309916,0.512344920771404,0.13771827771927672,6,83.08102250810028,0.1594220156320846,0.7727589642419826,1.0,False,forward_reverse_translation;forward_reverse_rotation -13,14,2.6059162757855927,23.989062825352686,0.6685967722064802,0.11944947118678222,6,17.494241627788213,0.00889966253307221,0.1868503363813343,1.0,True, -13,15,4.985522367267706,0.4809150034164723,0.6380833851897947,0.12132550246856395,6,19.285114979899365,0.011310526444604854,0.11618951108877962,1.0,True, -13,16,5.330126890587504,0.570225046299944,0.5094008523439458,0.12969283093489314,6,23.287780580490335,0.01929138406979036,0.6381307294537529,1.0,False,forward_reverse_rotation -14,15,2.3845573265941185,23.508147821936216,0.7915233415233415,0.11297936021484274,6,14.802453343324077,0.04714013527415902,0.5990777245962995,1.0,False,forward_reverse_rotation -14,16,7.871327660405588,24.55928787165262,0.515650129902264,0.1258655742770286,6,27.98905523695805,0.019790578845351906,0.2492103704468241,1.0,True, -14,17,6.334147330965719,0.13339551798522414,0.6016802569804793,0.12195151942370595,6,25.851285634799194,0.01939980613812204,0.1992615163030762,1.0,True, -15,16,10.188241681839806,1.051140049716416,0.4590676165479315,0.13331101566670972,6,37.36189113980903,0.03193705319987942,0.25820325147713563,1.0,True, -15,17,8.639041695194567,23.641543339921444,0.5389415876185721,0.1297159188720241,6,23.825996467364362,0.007152603768137945,0.01099978555369691,1.0,True, -15,18,9.620687246763701,76.25281000098852,0.5202642612120442,0.13378678930694327,6,39.71428865706424,0.023698091864950893,0.7026335973530661,1.0,False,forward_reverse_rotation -16,17,1.5531467972267479,24.69268338963786,0.7229415461973602,0.10903876418375444,6,27.565368871601265,0.004743603748938733,0.03110066538977425,1.0,True, -16,18,0.5677742310084086,77.30395005070493,0.75774251343742,0.10672872147965808,6,23.961833593584473,0.00729627345064471,0.5370128665073076,1.0,False,forward_reverse_rotation -16,19,2.9811390265794215,109.91770005034847,0.624375,0.11606003815798548,6,43.92870457834769,0.00942822069733503,0.10349184268425643,1.0,True, -17,18,0.98603936348044,52.61126666106708,0.8035782747603833,0.11258525838778834,6,10.5263751279628,0.04456291633933312,0.40754887525204303,1.0,True, -17,19,3.326868398717413,85.22501666071064,0.667207589564349,0.1151980232980854,6,37.82913063903142,0.002550382605456025,0.05599236133477508,1.0,True, -17,20,1.702964560097507,146.95247656520317,0.6696552595024624,0.11181113630432839,6,22.83917826847431,0.009851652453759501,0.030403861001117326,1.0,True, -18,19,3.0423123591285863,32.61374999964355,0.7803049555273189,0.10890373850857962,6,14.866928278077225,0.0027074586252039488,0.03345524421318835,1.0,True, -18,20,1.0853574230860805,94.34120990413592,0.7890203137053227,0.110891959946164,6,9.73093989119612,0.07641393239305394,0.480643469622101,1.0,True, -18,21,0.7190584934612743,134.43032499953063,0.7686106562539362,0.1151576675189467,6,11.132461972272983,0.012325022302827005,0.06184414805686676,1.0,True, -19,20,1.9962827272376449,61.72745990449234,0.7206177800100452,0.11075109929370276,6,18.593207910714877,0.06755956873701982,0.6275145294718035,1.0,False,forward_reverse_rotation -19,21,3.133843614009462,101.81657499988698,0.6599384615384616,0.1100348641166372,6,24.889550971173787,0.032753113036640115,0.1570816751009414,1.0,True, -19,22,3.558853688535236,131.87013333415302,0.6354319180087847,0.11655958277402616,6,35.20679617831266,0.011678083327496752,0.14115606360994692,1.0,True, -20,21,1.4312693216245356,40.08911509539463,0.8091622059006598,0.10860060068735904,6,9.844983425406634,0.004342811149796408,0.43079835067471983,1.0,True, -20,22,2.8745434122269677,70.1426734296607,0.7075518262586377,0.11619246575360609,6,10.41692741032582,0.03233653011234762,0.3501326921447133,1.0,True, -20,23,2.368927629183393,88.7954400941961,0.7127672722778395,0.11187552234677736,6,10.890181651202985,0.0036477332397017036,0.03588537530780425,1.0,True, -21,22,1.9888588003695142,30.053558334266054,0.7451905626134301,0.11103160300292489,6,9.138865693353942,0.007025231148999399,0.031656114821116355,1.0,True, -21,23,1.9477165743251885,48.70632499880147,0.7537566650508968,0.1091762180475198,6,10.033043192754391,0.0026262958914527778,0.05939834892732321,1.0,True, -21,24,3.76075382790461,86.89547500633407,0.7108181370133071,0.1147630411233105,6,12.077810466162274,0.002611195084459223,0.042823121286843194,1.0,True, -22,23,0.8778876913955667,18.652766664535406,0.8809323561215908,0.09065520084082093,6,9.426617095196006,0.00074030291113835,0.005760006892562891,1.0,True, -22,24,2.2510479983846268,56.84191667206801,0.7459386832783681,0.1116686389188481,6,10.471980698049531,0.010212372381123916,0.01461127103474581,1.0,True, -22,25,3.452614527841686,105.36038662410485,0.6250595521676989,0.10935727133461083,6,47.514851436189325,0.013489723519689117,0.0723917800582207,1.0,True, -23,24,1.8212773036309853,38.18915000753262,0.7936138977244923,0.11107653584131949,6,10.660643490600723,0.008437497431588122,0.2765568737620497,1.0,True, -23,25,2.999856552735995,86.70761995956946,0.6337826553739712,0.11196536842375276,6,43.84810300726168,0.02359951283541323,0.10308564406068685,1.0,True, -23,26,1.7088514993141615,157.34900000166795,0.6073053892215569,0.11004156310392302,6,52.70992994760862,0.013062761031411258,0.0548185753269731,1.0,True, -24,25,1.2059352225587747,48.51846995203683,0.7898629804777495,0.11080878069613129,6,17.323052863790767,0.024355899665769485,0.10833606018329535,1.0,True, -24,26,1.1958827550030364,119.15984999413537,0.7515217920623326,0.10216449744519186,6,27.478293204817643,0.010967953426658109,0.044641472084512177,1.0,True, -24,27,3.786115539231191,149.59794999698258,0.6259589210591437,0.11074683701330018,6,26.105827828207687,0.04374270593226806,0.34168251600562055,1.0,True, -25,26,1.8270495459501794,70.64138004209858,0.8273774189718628,0.10613402567174812,6,17.478877580241615,0.018863132797671257,0.12251687299132978,1.0,True, -25,27,4.741885618180033,101.07948004494568,0.6236883367506936,0.11275084173352168,6,26.65509822252546,0.005757137825848521,0.2558617834036415,1.0,True, -25,28,3.8640843382258447,141.59343004213218,0.5871679316888045,0.11732003715351383,6,52.15762909847497,1.0486443236448235,4.536374847153588,1.0,False,forward_reverse_translation;forward_reverse_rotation -26,27,2.939444415707082,30.43810000284707,0.6585129571324776,0.10848902314415616,6,30.227639491425478,0.002959097196576797,0.043581628031778105,1.0,True, -26,28,2.285770454773634,70.95205000003368,0.6648410525062507,0.11120026543063653,6,45.565898082132684,0.012512803173543077,0.11122589391716618,1.0,True, -26,29,3.6568094249627374,131.92299999999997,0.5895513507080804,0.11693751976202812,6,62.1400238672027,2.7672344834891307,9.168367379205225,0.0,False,forward_reverse_translation;forward_reverse_rotation;multistart_instability -27,28,2.3764785758716087,40.513949997186636,0.7954517962985364,0.10154002419986238,6,26.01517111533084,0.019135551099374308,0.08227568287606397,1.0,True, -27,29,4.061689152213973,101.48489999715295,0.7446499818643453,0.1104935519181424,6,32.698094109014136,0.015390416284740782,0.08645102756020058,1.0,True, -27,30,5.033742765789926,178.61309998505533,0.583363515634432,0.11446907648011068,6,105.65813856703667,0.017491035693048888,0.22327775856236398,0.0,False,multistart_instability -28,29,1.7860052935263149,60.970949999966315,0.8317879220161674,0.10401467258245657,6,16.856539687156317,0.007126704551442278,0.059447117802805614,1.0,True, -28,30,7.378510482049102,138.09914998778677,0.540360873694207,0.1217315596532435,6,243.03186464572013,0.02476143939627759,0.2783665026489561,1.0,True, -28,31,8.396001985859645,161.15751666826222,0.5051186318198242,0.12667907013046822,6,145.12677311467613,0.01381623315543165,0.08866229443960012,1.0,True, -29,30,8.925911734961222,77.12819998782052,0.5223065970574277,0.12780035193537048,6,94.88866430179526,0.06232017355575957,1.955625956099923,1.0,False,forward_reverse_rotation -29,31,9.936139535050964,100.18656666829587,0.49440231130371975,0.12866710903574613,6,130.4988571288183,0.047123741889749056,0.2295904679982487,1.0,True, -29,32,9.719184595429152,159.1482027457047,0.49802134548507015,0.12675987702934546,6,49.64602672737782,0.0323736334045635,0.06974950067660468,0.0,False,multistart_instability -30,31,1.0176267260390144,23.058366680475352,0.8480586608967424,0.09667505139943416,6,22.5712438700004,0.01573204986385798,0.04061482397026774,1.0,True, -30,32,0.8427696971904044,82.02000275788396,0.867680517303317,0.0986734040048058,6,23.367311395821964,0.002023273028745447,0.014811950864385802,1.0,True, -30,33,1.1320092061720382,147.1799498371321,0.7995722941665676,0.10006346131537393,6,41.688755802373954,0.00887908049317058,0.048438711468841336,1.0,True, -31,32,0.2771314063233405,58.9616360774086,0.8486026731470231,0.09714101002609693,6,27.412782801978597,0.012921368358244189,0.05809273577687571,1.0,True, -31,33,0.5409306841643147,124.12158315665668,0.07871263259402121,0.14967084978243636,6,33.0912130689722,2.900706563387122,12.11541439568944,1.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation -31,34,0.9901318542574941,155.5976733552555,0.7813404050144648,0.09211161518215291,6,17.31754498769328,3.351107529092291,8.098567652508597,0.0,False,forward_reverse_translation;forward_reverse_rotation;multistart_instability -32,33,0.38765596924480794,65.15994707924807,0.8592699327569645,0.08972486966187442,6,22.68434781952533,0.0035725430520846596,0.009168450597030125,1.0,True, -32,34,1.0327853226589305,96.63603727784675,0.8328530259365994,0.09815070141607997,6,23.927327238925002,0.04150636593087017,1.4498937658029205,1.0,False,forward_reverse_rotation -32,35,1.1947451269258382,131.6892972449946,0.8031309297912713,0.09391797152520207,6,30.896133075774756,0.007719527793580684,0.006042163579184511,0.0,False,multistart_instability -33,34,0.7453275493729801,31.47609019859864,0.8676435549201811,0.0964383255266311,6,26.835745049910184,0.02602048161602559,1.951142742234491,1.0,False,forward_reverse_rotation -33,35,1.0924186931915323,66.52935016574651,0.8329018592610026,0.09179860947142506,6,17.934600324801995,0.0072384331805243046,0.028209706778456432,1.0,True, -33,36,3.335020341384374,123.21987515531416,0.760797342192691,0.09861359027653524,6,26.32312350297475,0.0022735557932631,0.12221117701824208,1.0,True, -34,35,0.6186130964444055,35.05325996714787,0.8649093904448105,0.0788491357224537,6,23.02575456989985,0.0032110784907267375,0.015379666997505564,1.0,True, -34,36,3.114273556969299,91.74378495671547,0.7729789590254706,0.09845381444357724,6,36.91664640012635,0.011794412591703963,0.006135949966801849,1.0,True, -34,37,2.8155528331227235,126.08390993626574,0.722881252293017,0.09759501600127507,6,42.82845764024001,0.024742240312777743,0.08718512569927171,1.0,True, -35,36,2.4989423629184655,56.69052498956759,0.7695298262665533,0.09495386680108024,6,27.978829086780696,0.006644101856716534,0.038610475450088305,1.0,True, -35,37,2.2182956249874577,91.03064996911786,0.7217727327617437,0.10621413586570766,6,32.52725359303394,0.04503438705750094,1.5781812743250268,1.0,False,forward_reverse_rotation -36,37,0.5129211474320938,34.34012497955026,0.8785082174462705,0.08834636280188386,6,23.324824248042262,0.003787237363253161,0.027331592166342466,1.0,True, diff --git a/results/01_previous_two_batches/small_gicp/B_batch1_quality.json b/results/01_previous_two_batches/small_gicp/B_batch1_quality.json deleted file mode 100644 index 22efe53..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch1_quality.json +++ /dev/null @@ -1,13509 +0,0 @@ -{ - "schema_version": 2, - "backend": "small_gicp", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 38, - "candidate_pairs": 108, - "accepted_pairs": 88, - "parameters": { - "command": "pairs", - "backend": "small_gicp", - "frames": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_20260717\\prepared\\frames_all", - "body": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_20260717\\prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch1_auxiliary.npz", - "quality_json": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch1_quality.json", - "quality_csv": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch1_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 25, - "min_gap": 1, - "max_gap": 3, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 40, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 1, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 63, - "translation_rms_m": 0.0664787753932184, - "translation_p95_m": 0.12531710174530988, - "rotation_rms_deg": 0.8043301562784418, - "rotation_p95_deg": 1.45106782939295 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254210.7437553, - "frame_counter_i": 290, - "frame_counter_j": 1629, - "rtk_translation_m": 4.069460063439237, - "rtk_rotation_deg": 24.612641616688823, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9075295106990221, - -0.4198803284684745, - -0.009523495975725308, - 3.8578925073611345 - ], - [ - 0.41986917853279015, - 0.907578859702985, - -0.003238261637096342, - 1.3297043072351888 - ], - [ - 0.010003005977885603, - -0.0010598044330586646, - 0.9999494070631626, - 0.08877110081376957 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8495, - "backend_objective": 1419.5562494605936, - "backend_elapsed_sec": 0.11583209999662358, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4484, - "objective": 1160.8467243561226 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 7083, - "objective": 715.582901760881 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8495, - "objective": 1419.5562494605936 - } - ], - "heldout_symmetric": { - "evaluated": 8074, - "inliers": 5956, - "inlier_ratio": 0.7376764924448849, - "inlier_rmse_m": 0.11846276711125131, - "median_m": 0.1249111462723618, - "p90_m": 0.698044244050802, - "p95_m": 1.2454293461638448 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 54537.589455249414, - 109106.1893540175, - 243322.50789015717, - 289864.5928855995, - 734018.3759138099, - 773691.1686780683 - ], - "effective_rank": 6, - "scaled_condition_number": 14.186383674198092, - "weakest_scaled_direction": [ - -0.07056297298999306, - -0.06392926164732537, - -0.005261123688879415, - 0.8939534321475539, - -0.43661444490138723, - 0.03348618492205681 - ] - }, - "forward_reverse": { - "translation_m": 0.007238562624113292, - "rotation_deg": 0.02790414903884654 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.471372777539972e-15, - "rotation_deg": 2.977634497512081e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254309.6379356, - "frame_counter_i": 290, - "frame_counter_j": 2618, - "rtk_translation_m": 8.883155687691525, - "rtk_rotation_deg": 14.186041609026283, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9704260696876477, - -0.24139480923386628, - -0.001337664207658286, - 8.330368614153748 - ], - [ - 0.24127559811856186, - 0.9697402364331724, - 0.03728216188830926, - 3.2735982907310226 - ], - [ - -0.0077025335518517805, - -0.03650232756251504, - 0.9993038832404286, - 0.2368266713431066 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6745, - "backend_objective": 377.5443762338175, - "backend_elapsed_sec": 0.13857480000297073, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3898, - "objective": 1069.4493842719485 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5989, - "objective": 752.2262522447772 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6745, - "objective": 377.5443762338175 - } - ], - "heldout_symmetric": { - "evaluated": 8111, - "inliers": 5006, - "inlier_ratio": 0.617186536801874, - "inlier_rmse_m": 0.12801123590557925, - "median_m": 0.17099182728055204, - "p90_m": 1.0673697360950747, - "p95_m": 1.782115308895095 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18135.353464764343, - 22172.118807172737, - 34299.15062973867, - 64642.512586495184, - 490824.73908050696, - 667210.7637919699 - ], - "effective_rank": 6, - "scaled_condition_number": 36.79061260583155, - "weakest_scaled_direction": [ - -0.9766557619647595, - 0.1982847214981413, - -0.020804268909405663, - -5.755809065569502e-05, - -0.07166406185072292, - 0.035470172859842 - ] - }, - "forward_reverse": { - "translation_m": 0.006865219918284302, - "rotation_deg": 0.20055597955733165 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.6687789788066426e-15, - "rotation_deg": 1.7326209464727774e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784254076.8484204, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 290, - "frame_counter_j": 4051, - "rtk_translation_m": 5.800196618465403, - "rtk_rotation_deg": 50.885974946353855, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.639414338717261, - -0.7684870491464074, - -0.02401996538333898, - 5.210405016844213 - ], - [ - 0.768850587995233, - 0.6392652153585539, - 0.01444845223434835, - 2.0572597551663483 - ], - [ - 0.004251679921378009, - -0.027706312039519062, - 0.9996070645463722, - 0.16084716986256872 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8128, - "backend_objective": 787.6068744134022, - "backend_elapsed_sec": 0.12651049999840325, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4431, - "objective": 1111.0070489137622 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6939, - "objective": 597.1892952726225 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8128, - "objective": 787.6068744134022 - } - ], - "heldout_symmetric": { - "evaluated": 8067, - "inliers": 5797, - "inlier_ratio": 0.7186066691459031, - "inlier_rmse_m": 0.11701588647718943, - "median_m": 0.12605685560487936, - "p90_m": 0.7791298753514718, - "p95_m": 1.3750044466883258 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42585.88079951038, - 51166.15110135041, - 142443.51545837868, - 178602.73902818598, - 671900.9524970227, - 782045.334613628 - ], - "effective_rank": 6, - "scaled_condition_number": 18.363958192984455, - "weakest_scaled_direction": [ - 0.18318429727724675, - -0.06273150628804722, - 0.003050428766801109, - -0.6019455338498652, - 0.7731918863278172, - -0.048320258993972756 - ] - }, - "forward_reverse": { - "translation_m": 0.008227849157773135, - "rotation_deg": 0.05354665376691754 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.3323494796795866e-08, - "rotation_deg": 3.480408846494844e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254309.6379356, - "frame_counter_i": 1629, - "frame_counter_j": 2618, - "rtk_translation_m": 4.892046307546544, - "rtk_rotation_deg": 10.426600007662538, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.98209556457608, - 0.18761714323051198, - 0.01697379173943073, - 4.879887284156408 - ], - [ - -0.1879652917744415, - 0.9819297824200293, - 0.021976157186897688, - -0.10778030083227674 - ], - [ - -0.012543967798951675, - -0.024773170216499656, - 0.9996143951090758, - 0.1120135832698194 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8103, - "backend_objective": 580.0275395355195, - "backend_elapsed_sec": 0.10774469999887515, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4131, - "objective": 1023.4878795440385 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6609, - "objective": 784.7032422853447 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8103, - "objective": 580.0275395355195 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 5908, - "inlier_ratio": 0.7423043095866315, - "inlier_rmse_m": 0.11327867264180574, - "median_m": 0.11837650456537646, - "p90_m": 0.7091677370143424, - "p95_m": 1.1278433566182384 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29836.79366531935, - 40135.14352589949, - 93440.07041410673, - 165148.9515009127, - 564823.3797373081, - 777485.3428215547 - ], - "effective_rank": 6, - "scaled_condition_number": 26.05793878332379, - "weakest_scaled_direction": [ - 0.9847022513948113, - -0.1253867867200658, - 0.029155968461380747, - 0.0688888581652438, - 0.05887653111312335, - -0.07468225104976443 - ] - }, - "forward_reverse": { - "translation_m": 0.01880830643908174, - "rotation_deg": 0.13698190350335646 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.47545209131181e-16, - "rotation_deg": 8.580543765439374e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 1629, - "frame_counter_j": 4051, - "rtk_translation_m": 1.7315947839093804, - "rtk_rotation_deg": 26.273333329665036, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9029515825076172, - -0.4295456126791067, - -0.013000241348613778, - 1.5248789405838166 - ], - [ - 0.42961313410521745, - 0.9030086928201313, - 0.0028028013791009136, - 0.11187161683009733 - ], - [ - 0.010535399910954202, - -0.008115868370615904, - 0.9999115651042885, - 0.03214374355634652 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9464, - "backend_objective": 1171.2348919322044, - "backend_elapsed_sec": 0.14427490000525722, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4744, - "objective": 855.3719664816151 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7906, - "objective": 844.2146802260278 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9464, - "objective": 1171.2348919322044 - } - ], - "heldout_symmetric": { - "evaluated": 7915, - "inliers": 6640, - "inlier_ratio": 0.8389134554643083, - "inlier_rmse_m": 0.10681097771213023, - "median_m": 0.09187516317996168, - "p90_m": 0.3409731387256621, - "p95_m": 0.547028952051217 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 60935.04602182886, - 81463.24336745703, - 289786.06075070146, - 377031.77127746766, - 743033.4727588407, - 911356.3752439802 - ], - "effective_rank": 6, - "scaled_condition_number": 14.956194090958816, - "weakest_scaled_direction": [ - -0.1235123445420721, - -0.058341266079134285, - -0.0035028600851422283, - 0.6166908038339983, - -0.7752113830995462, - 0.008275951225921745 - ] - }, - "forward_reverse": { - "translation_m": 0.0035146019341874887, - "rotation_deg": 0.1349785173147079 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.124804769967568e-16, - "rotation_deg": 1.384139837342341e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784254210.7437553, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 1629, - "frame_counter_j": 4925, - "rtk_translation_m": 1.6946255625760025, - "rtk_rotation_deg": 60.40345832959281, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5151842366144779, - -0.856669673214476, - -0.026500440346553404, - -0.31261427976952594 - ], - [ - 0.8570361484039016, - 0.5152227343848989, - 0.005879991662726459, - -0.5460266080702179 - ], - [ - 0.008616418801543419, - -0.025741114341678667, - 0.999631508286671, - 0.007726831078988646 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 10142, - "backend_objective": 1818.399963982931, - "backend_elapsed_sec": 0.13278140000329586, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4587, - "objective": 870.9325760014979 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7765, - "objective": 877.4728015772384 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 10142, - "objective": 1818.399963982931 - } - ], - "heldout_symmetric": { - "evaluated": 8000, - "inliers": 7040, - "inlier_ratio": 0.88, - "inlier_rmse_m": 0.10289486740770283, - "median_m": 0.08679048004611667, - "p90_m": 0.2833603254929783, - "p95_m": 0.48750548427903695 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 91823.24021047422, - 144717.16615921727, - 339244.16707572, - 474785.8958078214, - 795434.4542297641, - 1086202.9364181557 - ], - "effective_rank": 6, - "scaled_condition_number": 11.829281279209892, - "weakest_scaled_direction": [ - -0.08954104308956745, - 0.04775693716848006, - -0.01273207970553586, - 0.09711398157347569, - -0.9895750722575166, - 0.029148270112771265 - ] - }, - "forward_reverse": { - "translation_m": 0.006064649004018339, - "rotation_deg": 0.061683233541617866 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2894690971977395e-15, - "rotation_deg": 6.911770998247423e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254452.9318, - "frame_counter_i": 2618, - "frame_counter_j": 4051, - "rtk_translation_m": 3.2805755806518446, - "rtk_rotation_deg": 36.69993333732758, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8059804480693027, - -0.5914949612697649, - -0.023004958649958, - -3.3228147972142335 - ], - [ - 0.5911570001961491, - 0.8063043222137941, - -0.020167823344274787, - -0.41969262652105443 - ], - [ - 0.030478163479727986, - 0.002655328950455516, - 0.9995319058334597, - -0.12935599839311795 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8824, - "backend_objective": 605.8739743886949, - "backend_elapsed_sec": 0.1384537999983877, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4613, - "objective": 962.1964851520374 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7430, - "objective": 965.3244323850722 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8824, - "objective": 605.8739743886949 - } - ], - "heldout_symmetric": { - "evaluated": 7952, - "inliers": 6322, - "inlier_ratio": 0.795020120724346, - "inlier_rmse_m": 0.10968948046836192, - "median_m": 0.10326340903122186, - "p90_m": 0.5015129471736163, - "p95_m": 0.8763534376207025 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40038.92921311286, - 47548.5491150434, - 121051.10452899779, - 249988.32456251388, - 604171.7957755475, - 959585.2407699784 - ], - "effective_rank": 6, - "scaled_condition_number": 23.96630628312886, - "weakest_scaled_direction": [ - 0.6255497542080171, - -0.7644047978466973, - 0.003909728736751036, - 0.10843469618954273, - -0.004508151075084643, - -0.11215666407579279 - ] - }, - "forward_reverse": { - "translation_m": 0.006456546110122383, - "rotation_deg": 0.030970536985363332 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0749410628466372e-07, - "rotation_deg": 8.533627666913859e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 2618, - "frame_counter_j": 4925, - "rtk_translation_m": 4.866335020594746, - "rtk_rotation_deg": 70.83005833725535, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3452654220406283, - -0.9377037015864895, - -0.03877571887285495, - -4.998702074608842 - ], - [ - 0.9383039040294165, - 0.345752089560366, - -0.006424659353182649, - -1.418690879382783 - ], - [ - 0.019431212681406514, - -0.03416519567690292, - 0.9992272851449189, - -0.2261639350676312 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7958, - "backend_objective": 495.7147734939361, - "backend_elapsed_sec": 0.19552670000120997, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 4274, - "objective": 1187.812774214254 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6583, - "objective": 640.6275466576219 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7958, - "objective": 495.7147734939361 - } - ], - "heldout_symmetric": { - "evaluated": 8037, - "inliers": 5779, - "inlier_ratio": 0.7190493965409979, - "inlier_rmse_m": 0.11680954298455397, - "median_m": 0.12641487967099882, - "p90_m": 0.8037358246776285, - "p95_m": 1.2848017881525493 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36588.18396564015, - 43675.302958527755, - 84860.60588175566, - 201347.90831126898, - 503011.22393196257, - 868243.273566192 - ], - "effective_rank": 6, - "scaled_condition_number": 23.730154915082874, - "weakest_scaled_direction": [ - 0.16434209166166802, - -0.253031959060958, - 0.005671672221997766, - -0.06311976365094335, - 0.9379721503461323, - -0.158614240684592 - ] - }, - "forward_reverse": { - "translation_m": 0.005632827193528356, - "rotation_deg": 0.03284052493715785 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0601005736791587e-14, - "rotation_deg": 6.775803864846617e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784254309.6379356, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 2618, - "frame_counter_j": 6824, - "rtk_translation_m": 1.8274406190287722, - "rtk_rotation_deg": 30.448549979291712, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8590689160649139, - 0.5118076326911972, - -0.007317415533331473, - -1.189983463465544 - ], - [ - -0.5118531162563104, - 0.8588958652244919, - -0.017443625740522422, - -2.2328519970963328 - ], - [ - -0.002642882850100138, - 0.018730718600830615, - 0.9998210716677948, - -0.07155564235720886 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 16, - "backend_num_inliers": 8407, - "backend_objective": 1100.768024070376, - "backend_elapsed_sec": 0.13311930000054417, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4600, - "objective": 933.215878236095 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7208, - "objective": 721.7457949388754 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 16, - "num_inliers": 8407, - "objective": 1100.768024070376 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 6148, - "inlier_ratio": 0.7598566308243727, - "inlier_rmse_m": 0.11774293624986373, - "median_m": 0.12025710930469159, - "p90_m": 0.5815500770528812, - "p95_m": 0.9770707576366456 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47859.29225718762, - 67923.32855932058, - 140816.98754306263, - 245080.9987405256, - 541139.8836937749, - 794434.5320483233 - ], - "effective_rank": 6, - "scaled_condition_number": 16.599379025063065, - "weakest_scaled_direction": [ - -0.202773423191442, - 0.13353740400348174, - -0.005116177998680206, - -0.9274808724747672, - -0.27654258843811397, - -0.06578718169456611 - ] - }, - "forward_reverse": { - "translation_m": 0.028141707120452414, - "rotation_deg": 0.19962462817569399 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.890150443143122e-16, - "rotation_deg": 8.442966173497864e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254540.3289933, - "frame_counter_i": 4051, - "frame_counter_j": 4925, - "rtk_translation_m": 1.75881263274858, - "rtk_rotation_deg": 34.13012499992777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8334808060105731, - -0.5525264487008953, - -0.004926408219384689, - -1.9506625269924571 - ], - [ - 0.5524869012505402, - 0.8332218696701024, - 0.02235038814062036, - 0.1881639107124969 - ], - [ - -0.00824438951910969, - -0.02135039553351643, - 0.9997380610199954, - -0.036753466207138846 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9636, - "backend_objective": 1109.363243980891, - "backend_elapsed_sec": 0.12044829999649664, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4591, - "objective": 893.6063869083783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7508, - "objective": 871.2362800434747 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9636, - "objective": 1109.363243980891 - } - ], - "heldout_symmetric": { - "evaluated": 7993, - "inliers": 6706, - "inlier_ratio": 0.83898411109721, - "inlier_rmse_m": 0.10512726552504312, - "median_m": 0.09158381975809049, - "p90_m": 0.3935879562991502, - "p95_m": 0.6462965409595868 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 57251.52222626075, - 79020.8908201862, - 275291.45720782824, - 397229.96669411013, - 698670.2347970392, - 896825.9803962101 - ], - "effective_rank": 6, - "scaled_condition_number": 15.664666117555983, - "weakest_scaled_direction": [ - 0.09911310269445285, - -0.09358797793019935, - -0.00026470996724776877, - -0.07771497649829129, - 0.9866059904357699, - -0.0445737058586343 - ] - }, - "forward_reverse": { - "translation_m": 0.006186049607122224, - "rotation_deg": 0.016880074405568043 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0585914528227036e-08, - "rotation_deg": 1.57222200041169e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 4051, - "frame_counter_j": 6824, - "rtk_translation_m": 2.1020200425132134, - "rtk_rotation_deg": 67.14848331661929, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.39013938186708846, - 0.9207554148904398, - 0.0008536195292267056, - 0.6704590643763693 - ], - [ - -0.9204864180499497, - 0.3900474927553313, - -0.023826614968424566, - -2.726427017904929 - ], - [ - -0.022271436907828356, - 0.008509955652930907, - 0.9997157414749687, - -0.05218351952781692 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 8901, - "backend_objective": 1037.7413288393354, - "backend_elapsed_sec": 0.1251440000050934, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4692, - "objective": 966.7831391320129 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 7423, - "objective": 902.2893645891601 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 8901, - "objective": 1037.7413288393354 - } - ], - "heldout_symmetric": { - "evaluated": 8047, - "inliers": 6412, - "inlier_ratio": 0.7968186901951038, - "inlier_rmse_m": 0.11623997504357782, - "median_m": 0.10852360312106603, - "p90_m": 0.49803134115315295, - "p95_m": 0.8480172873346057 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 54228.00830401395, - 60610.65313820339, - 164486.659173634, - 247402.48301184518, - 711616.8507171773, - 984500.81560399 - ], - "effective_rank": 6, - "scaled_condition_number": 18.1548400244513, - "weakest_scaled_direction": [ - 0.8368247806918776, - 0.12094592367079998, - 0.02234953015729625, - 0.38248077339922426, - 0.19099014457100655, - -0.3191051411773765 - ] - }, - "forward_reverse": { - "translation_m": 0.021983524103315014, - "rotation_deg": 0.3960603757299183 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.901580930790967e-06, - "rotation_deg": 1.8931122680702625e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784254452.9318, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 4051, - "frame_counter_j": 8269, - "rtk_translation_m": 5.791805311102367, - "rtk_rotation_deg": 61.163322289150074, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4872414160330809, - 0.8732614493640616, - -0.0032005556794521407, - 2.302607512959937 - ], - [ - -0.8730540992810985, - 0.4870381959720164, - -0.02388169576880501, - -6.094465394780589 - ], - [ - -0.019296171396109854, - 0.014430409519586873, - 0.9997096683790493, - -0.04249545518257287 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7330, - "backend_objective": 599.2417932780519, - "backend_elapsed_sec": 0.10523429999739164, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4336, - "objective": 973.534052327611 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6315, - "objective": 714.1480065346007 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7330, - "objective": 599.2417932780519 - } - ], - "heldout_symmetric": { - "evaluated": 7970, - "inliers": 5235, - "inlier_ratio": 0.6568381430363864, - "inlier_rmse_m": 0.12435814704811046, - "median_m": 0.15347591580093184, - "p90_m": 0.9338148002504841, - "p95_m": 1.327879146098951 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32041.297192069233, - 37042.5880867479, - 101231.52297135191, - 333106.08393038344, - 590439.5632053812, - 801519.1714724554 - ], - "effective_rank": 6, - "scaled_condition_number": 25.0151910725651, - "weakest_scaled_direction": [ - 0.6730540870750039, - 0.04331808018479871, - 0.010484031258892627, - 0.6633301743639659, - 0.16939803218697316, - -0.27624121951430575 - ] - }, - "forward_reverse": { - "translation_m": 0.008738020425158864, - "rotation_deg": 0.1291569973379011 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1805095966397748e-15, - "rotation_deg": 3.3767929786633064e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784254730.2200227, - "frame_counter_i": 4925, - "frame_counter_j": 6824, - "rtk_translation_m": 3.30592832159088, - "rtk_rotation_deg": 101.27860831654709, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.18359230993557477, - 0.9828926416022686, - -0.014694176283017078, - 0.5663015828341036 - ], - [ - -0.98250560954136, - -0.1839542268939685, - -0.02904427013379363, - -3.8812467487626896 - ], - [ - -0.031250455233200344, - 0.009104805981397868, - 0.9994701153890292, - 0.004959527766643625 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8400, - "backend_objective": 911.4913163390977, - "backend_elapsed_sec": 0.09745829999883426, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4506, - "objective": 1113.7327386531388 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6957, - "objective": 647.8837745879555 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8400, - "objective": 911.4913163390977 - } - ], - "heldout_symmetric": { - "evaluated": 8132, - "inliers": 6134, - "inlier_ratio": 0.7543039842597147, - "inlier_rmse_m": 0.11308907219490882, - "median_m": 0.1168775716511344, - "p90_m": 0.6746290034355518, - "p95_m": 1.1181369269608676 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44947.431756563106, - 61648.316363810285, - 166790.5308173608, - 224400.74018827506, - 689403.5226343169, - 885035.4152865735 - ], - "effective_rank": 6, - "scaled_condition_number": 19.690455732375476, - "weakest_scaled_direction": [ - -0.10716311382158174, - 0.08586699801661055, - -0.0008073554541294499, - -0.9510143700927586, - -0.2768891757940208, - -0.006806325736488089 - ] - }, - "forward_reverse": { - "translation_m": 0.002243469564109645, - "rotation_deg": 0.06843841908142442 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.9771654112948742e-05, - "rotation_deg": 3.6557381577460834e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 4925, - "frame_counter_j": 8269, - "rtk_translation_m": 6.453995240105232, - "rtk_rotation_deg": 95.29344728907782, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.0761643009195314, - 0.9969333111420099, - -0.0179714329108343, - 0.0694852240356869 - ], - [ - -0.9963431110286839, - -0.07679443543652612, - -0.03745690579412132, - -7.602440994147095 - ], - [ - -0.0387221431628406, - 0.015052834331605909, - 0.9991366312008889, - -0.09129127155249375 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7061, - "backend_objective": 501.2158248445944, - "backend_elapsed_sec": 0.10252220000256784, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4143, - "objective": 1077.3175804426153 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6027, - "objective": 669.5069340402744 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7061, - "objective": 501.2158248445944 - } - ], - "heldout_symmetric": { - "evaluated": 8055, - "inliers": 5009, - "inlier_ratio": 0.6218497827436374, - "inlier_rmse_m": 0.12814112793605542, - "median_m": 0.1724292622223383, - "p90_m": 1.1419707012563336, - "p95_m": 1.6347814177529423 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20318.019089768848, - 26046.04340751875, - 94247.52607682813, - 248117.3465477399, - 543507.5588911963, - 850238.2080237141 - ], - "effective_rank": 6, - "scaled_condition_number": 41.84651093530334, - "weakest_scaled_direction": [ - 0.8010506600300783, - 0.18089948331128958, - 0.02639609582476531, - 0.025407754342461893, - 0.0690416122485284, - -0.5652293029609234 - ] - }, - "forward_reverse": { - "translation_m": 0.01600824572236542, - "rotation_deg": 0.4490447249637784 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.5293263533313107e-15, - "rotation_deg": 1.0848260921829398e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784254540.3289933, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 4925, - "frame_counter_j": 9966, - "rtk_translation_m": 9.537609568572432, - "rtk_rotation_deg": 26.32130681988008, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9012859002216211, - 0.4328634905072854, - 0.01768967629869551, - 2.788852448474315 - ], - [ - -0.43281056517773553, - 0.9014583602413565, - -0.0069166047664048925, - -9.638358803988043 - ], - [ - -0.01894045227106776, - -0.0014224404432832008, - 0.9998196016937021, - -0.07212204522133751 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6672, - "backend_objective": 461.5413673010648, - "backend_elapsed_sec": 0.12260190000233706, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4049, - "objective": 1057.6983561567229 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6068, - "objective": 611.8601702792623 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6672, - "objective": 461.5413673010648 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 4864, - "inlier_ratio": 0.6169457128361238, - "inlier_rmse_m": 0.13205154815512993, - "median_m": 0.17878599431318648, - "p90_m": 0.9655270589149846, - "p95_m": 1.500082164007766 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20502.076327836287, - 23318.08104857806, - 30314.035636834924, - 157225.55383402307, - 552144.6093308728, - 757097.907918101 - ], - "effective_rank": 6, - "scaled_condition_number": 36.92786505190044, - "weakest_scaled_direction": [ - -0.4908469303707232, - 0.8499543170647914, - 0.003503242533680151, - -0.13743112109202668, - 0.0821300037526303, - 0.10489054570977203 - ] - }, - "forward_reverse": { - "translation_m": 0.019160428104594212, - "rotation_deg": 0.2888349968548246 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.440913782491137e-15, - "rotation_deg": 1.7464017574838592e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784254874.714136, - "frame_counter_i": 6824, - "frame_counter_j": 8269, - "rtk_translation_m": 3.7769167422851373, - "rtk_rotation_deg": 5.985161027469212, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9941731843874824, - -0.10777654272386936, - 0.0019739005402346814, - 3.7583464305930074 - ], - [ - 0.10777211287964342, - 0.9941731275643675, - 0.0022280292506504985, - 0.19386407213213588 - ], - [ - -0.0022025281633088712, - -0.0020023155031923014, - 0.9999955697913441, - 0.07876084309176457 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8480, - "backend_objective": 1193.496445709331, - "backend_elapsed_sec": 0.11797059999662451, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4578, - "objective": 1092.0157816412705 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7122, - "objective": 897.6652674932944 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8480, - "objective": 1193.496445709331 - } - ], - "heldout_symmetric": { - "evaluated": 8109, - "inliers": 5978, - "inlier_ratio": 0.7372055740535208, - "inlier_rmse_m": 0.1175976253407229, - "median_m": 0.12226674243236164, - "p90_m": 0.6208516903742961, - "p95_m": 0.9143172904130269 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 49323.02430729194, - 125534.1588714078, - 245264.75701489748, - 407823.04748443386, - 646820.8524957768, - 953053.9820670647 - ], - "effective_rank": 6, - "scaled_condition_number": 19.32269960027907, - "weakest_scaled_direction": [ - 0.017565505599826902, - -0.05636268757724919, - -0.0035692895806746765, - 0.9846808009997982, - 0.16319393977717633, - 0.01653538014017545 - ] - }, - "forward_reverse": { - "translation_m": 0.013833903611932107, - "rotation_deg": 0.01952771029395653 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 0.0001043611665008492, - "rotation_deg": 0.0009244862734347193 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 6824, - "frame_counter_j": 9966, - "rtk_translation_m": 6.565348405821576, - "rtk_rotation_deg": 74.95730149666699, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.26054750468310556, - -0.964909565831778, - -0.03262709870242987, - 5.2549319472088 - ], - [ - 0.9653954232932429, - 0.25998702627377246, - 0.020455386913533442, - 3.247227111706031 - ], - [ - -0.011254976138072971, - -0.03682765178031127, - 0.99925824969148, - 0.1318153810149665 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7775, - "backend_objective": 562.0165783262432, - "backend_elapsed_sec": 0.11080930000025546, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4189, - "objective": 923.4292425792835 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6616, - "objective": 545.1751630316442 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7775, - "objective": 562.0165783262432 - } - ], - "heldout_symmetric": { - "evaluated": 7938, - "inliers": 5431, - "inlier_ratio": 0.6841773746535651, - "inlier_rmse_m": 0.11964187966504931, - "median_m": 0.1376897092727266, - "p90_m": 0.8602449375376173, - "p95_m": 1.3480635524938431 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35810.32648680093, - 43005.47427858367, - 64041.61624715142, - 173770.551892475, - 677620.1998154683, - 978760.9493623399 - ], - "effective_rank": 6, - "scaled_condition_number": 27.33180748081407, - "weakest_scaled_direction": [ - 0.13964394562979016, - -0.7172707167627975, - -0.01059837863261426, - 0.360039244862617, - -0.5136565607308332, - 0.2691442763107074 - ] - }, - "forward_reverse": { - "translation_m": 0.003240486196092054, - "rotation_deg": 0.04738439683023512 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.066166486170095e-14, - "rotation_deg": 1.1726944413877017e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784254730.2200227, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 6824, - "frame_counter_j": 11343, - "rtk_translation_m": 6.3343271669452825, - "rtk_rotation_deg": 107.99940292217995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.30303235887587643, - -0.9511094447910896, - -0.05968428187813471, - 3.9970312661279346 - ], - [ - 0.948965548839459, - -0.30690609286881493, - 0.07261568202409091, - -1.5615231430063556 - ], - [ - -0.08738293076995866, - -0.03463342589443221, - 0.9955725735579842, - 0.09735327156591295 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7769, - "backend_objective": 1148.164060782922, - "backend_elapsed_sec": 0.14825349999591708, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4152, - "objective": 1054.890380916233 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6388, - "objective": 883.8075551579429 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7769, - "objective": 1148.164060782922 - } - ], - "heldout_symmetric": { - "evaluated": 8402, - "inliers": 5479, - "inlier_ratio": 0.6521066412758867, - "inlier_rmse_m": 0.12472719695199193, - "median_m": 0.15469550929281028, - "p90_m": 1.180389161208582, - "p95_m": 1.975031697352117 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42495.254002897476, - 71868.37534205409, - 113557.32982962685, - 216032.1456465367, - 587310.6035452144, - 814081.308660922 - ], - "effective_rank": 6, - "scaled_condition_number": 19.156993592870748, - "weakest_scaled_direction": [ - -0.25406982263997696, - -0.04036609743603481, - -0.03151801733395084, - -0.029195296358704506, - -0.9651749418204849, - 0.020265348187565566 - ] - }, - "forward_reverse": { - "translation_m": 0.0278691016568626, - "rotation_deg": 0.41056933218195657 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6653345369377348e-16, - "rotation_deg": 1.3764447018363758e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255044.4073362, - "frame_counter_i": 8269, - "frame_counter_j": 9966, - "rtk_translation_m": 3.1558607172566147, - "rtk_rotation_deg": 68.97214046919777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3630446383557725, - -0.9313122334952554, - -0.029259431013027467, - 1.8225878308697732 - ], - [ - 0.9317308902126622, - 0.36255561756789395, - 0.020759874601823103, - 2.8776937807071175 - ], - [ - -0.008725754101891928, - -0.03479867687201411, - 0.999356249444266, - 0.03947628102212908 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8707, - "backend_objective": 944.2950466286643, - "backend_elapsed_sec": 0.12534570000570966, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4339, - "objective": 1028.3343223278594 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6955, - "objective": 599.3923566969368 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8707, - "objective": 944.2950466286643 - } - ], - "heldout_symmetric": { - "evaluated": 7861, - "inliers": 5926, - "inlier_ratio": 0.7538481109273629, - "inlier_rmse_m": 0.11470554120698542, - "median_m": 0.1168472923129069, - "p90_m": 0.7279981506322535, - "p95_m": 1.1997176243817322 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 63857.05635523845, - 81008.9187250498, - 137530.4557625456, - 249041.24680841013, - 645791.3197615729, - 1095797.9851185093 - ], - "effective_rank": 6, - "scaled_condition_number": 17.160170663404163, - "weakest_scaled_direction": [ - -0.030660892244699964, - -0.18140578074530625, - 0.00421494749753814, - 0.5031803452335986, - -0.8309641812427485, - 0.14980706351405199 - ] - }, - "forward_reverse": { - "translation_m": 0.03433121044907878, - "rotation_deg": 0.14981218442224864 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8572224350538414e-07, - "rotation_deg": 2.274491796619444e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 8269, - "frame_counter_j": 11343, - "rtk_translation_m": 3.3979014114419868, - "rtk_rotation_deg": 102.01424189471071, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.19885562676254928, - -0.9785663865976864, - -0.05351884458787667, - 0.05198857371880225 - ], - [ - 0.9759408709576742, - -0.20271332113040136, - 0.08029150534558002, - -1.7722416498908506 - ], - [ - -0.08941955098998337, - -0.03626481018053689, - 0.9953336161525537, - 0.07567295648550776 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8125, - "backend_objective": 834.188675687352, - "backend_elapsed_sec": 0.14796390000265092, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4059, - "objective": 1181.7388399688562 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6464, - "objective": 634.6625902514388 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8125, - "objective": 834.188675687352 - } - ], - "heldout_symmetric": { - "evaluated": 8325, - "inliers": 5686, - "inlier_ratio": 0.683003003003003, - "inlier_rmse_m": 0.11564979549315224, - "median_m": 0.13272137786142862, - "p90_m": 1.3644082022884454, - "p95_m": 2.2069891099187986 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 49346.3758717713, - 86125.18384917779, - 174917.3354892822, - 295169.5983070183, - 618042.7612006412, - 1008986.3267600462 - ], - "effective_rank": 6, - "scaled_condition_number": 20.447019845630425, - "weakest_scaled_direction": [ - -0.14173996510489542, - 0.0317989971478114, - -0.014613027747017088, - -0.040137338987899104, - -0.9884576926727731, - -0.005044730667698053 - ] - }, - "forward_reverse": { - "translation_m": 0.008147035817338538, - "rotation_deg": 0.038229943243018406 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5366164491566369e-15, - "rotation_deg": 1.0830005998172587e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784254874.714136, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 8269, - "frame_counter_j": 14121, - "rtk_translation_m": 0.28270347875173524, - "rtk_rotation_deg": 124.11602215258995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5643737680034951, - 0.8250195387290573, - -0.02872299957928165, - -1.7901683709152019 - ], - [ - -0.8238867050411328, - -0.5651037305916229, - -0.04322581321268311, - -0.9246679376129474 - ], - [ - -0.051893614693949874, - -0.0007310175955850418, - 0.9986523511048628, - -0.059710939706568364 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8487, - "backend_objective": 1211.003438465407, - "backend_elapsed_sec": 0.1321449000024586, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4678, - "objective": 956.9721291359658 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7151, - "objective": 722.1992711785097 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8487, - "objective": 1211.003438465407 - } - ], - "heldout_symmetric": { - "evaluated": 7872, - "inliers": 5794, - "inlier_ratio": 0.7360264227642277, - "inlier_rmse_m": 0.11829700338913093, - "median_m": 0.12719220633339834, - "p90_m": 0.6293384174774208, - "p95_m": 0.8983055863917024 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 62334.41190573761, - 163776.75113679928, - 277710.896040931, - 388439.3582754507, - 720865.8886553734, - 1135476.4611285843 - ], - "effective_rank": 6, - "scaled_condition_number": 18.21588471622476, - "weakest_scaled_direction": [ - -0.07438414669468418, - -0.06615499380656412, - 0.015556662908032974, - 0.6901719452919817, - -0.7158715970127876, - 0.0322342717672605 - ] - }, - "forward_reverse": { - "translation_m": 0.003942462178993821, - "rotation_deg": 0.004948404195791413 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.1464231286487715e-15, - "rotation_deg": 1.4474072110608484e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255182.1007738, - "frame_counter_i": 9966, - "frame_counter_j": 11343, - "rtk_translation_m": 4.78580085090425, - "rtk_rotation_deg": 33.04210142551296, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8371876775086143, - -0.5443878611805864, - 0.05252284481024743, - -4.976138309278738 - ], - [ - 0.5433688245976859, - 0.838833368404928, - 0.033300157743970896, - -0.0406478929153348 - ], - [ - -0.0621861164816055, - 0.0006607947267253034, - 0.9980643517665909, - -0.05554804089558046 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7329, - "backend_objective": 683.299086839249, - "backend_elapsed_sec": 0.14698669999779668, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3921, - "objective": 1904.9533673598169 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 9, - "num_inliers": 5914, - "objective": 639.5487359077345 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7329, - "objective": 683.299086839249 - } - ], - "heldout_symmetric": { - "evaluated": 8154, - "inliers": 5418, - "inlier_ratio": 0.6644591611479028, - "inlier_rmse_m": 0.12091344193997677, - "median_m": 0.14767837666862524, - "p90_m": 1.3052473958139093, - "p95_m": 2.250651872087495 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38088.55699491429, - 52940.15235403108, - 103937.37806686808, - 116005.45755665108, - 457394.01968231867, - 862725.337432937 - ], - "effective_rank": 6, - "scaled_condition_number": 22.65051252921267, - "weakest_scaled_direction": [ - 0.15814237700539974, - 0.020238737142548452, - 0.007099193775197262, - 0.03445176847254157, - 0.9865734926178724, - -0.004099130955096478 - ] - }, - "forward_reverse": { - "translation_m": 0.010087854632047892, - "rotation_deg": 0.1144705976875931 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.766123987276198e-13, - "rotation_deg": 7.704264889356407e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 9966, - "frame_counter_j": 14121, - "rtk_translation_m": 2.876695741106431, - "rtk_rotation_deg": 166.91183737821345, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9723184740558365, - -0.22693651217474295, - -0.05564714234974994, - -4.852184847059252 - ], - [ - 0.22898308540648776, - -0.9728507191500739, - -0.03358905844036536, - 1.9926220140412132 - ], - [ - -0.04651377868391067, - -0.04540151639700811, - 0.9978853494772812, - -0.12014308155015331 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6829, - "backend_objective": 470.96005368209137, - "backend_elapsed_sec": 0.14210660000389908, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 4144, - "objective": 945.0651383634521 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5966, - "objective": 570.5851502326218 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6829, - "objective": 470.96005368209137 - } - ], - "heldout_symmetric": { - "evaluated": 7701, - "inliers": 4742, - "inlier_ratio": 0.6157641864692897, - "inlier_rmse_m": 0.12124276796057824, - "median_m": 0.16456346238932687, - "p90_m": 1.3049951813784684, - "p95_m": 1.862571472093361 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 30129.420441890892, - 33640.328206822946, - 56858.5391998517, - 79320.81114176704, - 531625.269684721, - 960822.3966047498 - ], - "effective_rank": 6, - "scaled_condition_number": 31.889839980753695, - "weakest_scaled_direction": [ - -0.41568596130170454, - 0.6987875715816618, - 0.011071446107222676, - -0.3241579962884871, - 0.25268924582406627, - -0.4121265254116441 - ] - }, - "forward_reverse": { - "translation_m": 2.858085971145254, - "rotation_deg": 5.202834749913653 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.30488109183663e-15, - "rotation_deg": 5.722347377885308e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784255044.4073362, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 9966, - "frame_counter_j": 16041, - "rtk_translation_m": 3.5227760858025783, - "rtk_rotation_deg": 151.5297683494061, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8913789209931571, - 0.45316209288754455, - -0.009366791278559035, - 0.7187744492948136 - ], - [ - -0.4527570490803627, - -0.8911740427549801, - -0.02863354724421385, - 0.8607369452555236 - ], - [ - -0.021323079447337856, - -0.021282459668121853, - 0.9995460885788894, - 0.023730045987029647 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9002, - "backend_objective": 1141.8747282330294, - "backend_elapsed_sec": 0.09278530000301544, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4106, - "objective": 816.6647415495502 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6990, - "objective": 769.8282297300373 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9002, - "objective": 1141.8747282330294 - } - ], - "heldout_symmetric": { - "evaluated": 7825, - "inliers": 6590, - "inlier_ratio": 0.8421725239616613, - "inlier_rmse_m": 0.10512064341715703, - "median_m": 0.09117209084671556, - "p90_m": 0.38088851426429754, - "p95_m": 0.8138579955684165 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 71794.92398004432, - 89154.47255122576, - 364238.8443261626, - 466735.64165546553, - 876627.12771609, - 1307251.8438572641 - ], - "effective_rank": 6, - "scaled_condition_number": 18.208137447441548, - "weakest_scaled_direction": [ - 0.08567315926399108, - 0.6686469498724462, - 0.005231584245818575, - -0.0813548434173919, - 0.23213218221985762, - 0.6964481575570851 - ] - }, - "forward_reverse": { - "translation_m": 0.00590396821278501, - "rotation_deg": 0.011716048666689089 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6478417331663793e-15, - "rotation_deg": 1.3475243284190944e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255459.889231, - "frame_counter_i": 11343, - "frame_counter_j": 14121, - "rtk_translation_m": 3.469611483011297, - "rtk_rotation_deg": 133.86973595269956, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.687688017340456, - -0.715448620381765, - -0.12336313225668985, - 1.2026642429979968 - ], - [ - 0.7211958223826048, - -0.69272549968353, - -0.0028227408812730834, - 1.6361778880945292 - ], - [ - -0.08343726136583877, - -0.09091014069966591, - 0.99235758158727, - 0.050646434538553595 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7191, - "backend_objective": 960.8236828448823, - "backend_elapsed_sec": 0.12328420000267215, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4446, - "objective": 1112.8485846145088 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6336, - "objective": 565.4275518167565 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7191, - "objective": 960.8236828448823 - } - ], - "heldout_symmetric": { - "evaluated": 8165, - "inliers": 4897, - "inlier_ratio": 0.5997550520514391, - "inlier_rmse_m": 0.12251997518546373, - "median_m": 0.1744594963563933, - "p90_m": 1.4613095938288019, - "p95_m": 2.224910063597178 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35160.059647672904, - 52580.5161901671, - 127403.453112862, - 187793.80506886885, - 582499.3367499047, - 934707.0957095041 - ], - "effective_rank": 6, - "scaled_condition_number": 26.58434328826198, - "weakest_scaled_direction": [ - 0.35162647926247986, - -0.6917658117112064, - -0.009043539299586945, - 0.07677609603264249, - -0.005523112903938974, - 0.6259488968979678 - ] - }, - "forward_reverse": { - "translation_m": 0.1455308769088698, - "rotation_deg": 0.6888512968600221 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5842512794148288e-15, - "rotation_deg": 1.5480991661434066e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 11343, - "frame_counter_j": 16041, - "rtk_translation_m": 8.226583602288494, - "rtk_rotation_deg": 175.42813022508852, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9910284427521264, - -0.10202939962484166, - -0.08632860052433311, - 5.253980968341697 - ], - [ - 0.10488012405334303, - -0.9940576991103349, - -0.02914533269708561, - -2.3515876061158405 - ], - [ - -0.08284192920768384, - -0.037938008008628926, - 0.9958403096448174, - 0.36215514875049026 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6783, - "backend_objective": 404.133680216633, - "backend_elapsed_sec": 0.09851479999633739, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3536, - "objective": 764.0472438230894 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5521, - "objective": 430.46872759972564 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6783, - "objective": 404.133680216633 - } - ], - "heldout_symmetric": { - "evaluated": 8289, - "inliers": 4903, - "inlier_ratio": 0.5915068162625166, - "inlier_rmse_m": 0.1229044134151169, - "median_m": 0.17512834661570034, - "p90_m": 1.8029020597988636, - "p95_m": 2.4718466983087364 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26625.009049254368, - 38399.85047214927, - 43830.00000538044, - 93434.15474186266, - 452075.91943737236, - 748466.8119687974 - ], - "effective_rank": 6, - "scaled_condition_number": 28.111420003057543, - "weakest_scaled_direction": [ - -0.15701641964946786, - -0.9250420578866461, - -0.006046810953149903, - 0.08113493264006809, - -0.14066986334178935, - -0.30534502359051424 - ] - }, - "forward_reverse": { - "translation_m": 0.008997663249148741, - "rotation_deg": 0.15439288797351725 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.8510861166685117e-16, - "rotation_deg": 2.657214113456235e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784255182.1007738, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 11343, - "frame_counter_j": 17319, - "rtk_translation_m": 1.865267488778983, - "rtk_rotation_deg": 173.7180803410843, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9942836853064142, - -0.10630567636895012, - -0.009952703413366317, - -3.163860192410452 - ], - [ - 0.10656009174018367, - -0.9938531268650087, - -0.03001514732544495, - -1.655474050900978 - ], - [ - -0.0067007448703890644, - -0.030904132286549552, - 0.9994998922590228, - 0.014671640960376101 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8253, - "backend_objective": 1433.2272792220815, - "backend_elapsed_sec": 0.11496289999922737, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3836, - "objective": 1017.5403000055619 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6359, - "objective": 732.6236806119822 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8253, - "objective": 1433.2272792220815 - } - ], - "heldout_symmetric": { - "evaluated": 8379, - "inliers": 5728, - "inlier_ratio": 0.6836137963957513, - "inlier_rmse_m": 0.11276660610764273, - "median_m": 0.12777033933126322, - "p90_m": 1.0423218170091904, - "p95_m": 1.7984595275100435 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24111.184730835572, - 52350.37613147848, - 132593.9961136753, - 687113.1263590176, - 750849.4653551282, - 907000.6947469178 - ], - "effective_rank": 6, - "scaled_condition_number": 37.61742547586071, - "weakest_scaled_direction": [ - -0.044075463417279186, - -0.6504257768564558, - 0.008070227484647524, - 0.11126698332619576, - 0.006907379917565726, - 0.7500069868192806 - ] - }, - "forward_reverse": { - "translation_m": 0.1113060196402131, - "rotation_deg": 0.53316971567076 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4311491945847312e-15, - "rotation_deg": 1.2510186729654515e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255651.8811028, - "frame_counter_i": 14121, - "frame_counter_j": 16041, - "rtk_translation_m": 5.488028285806731, - "rtk_rotation_deg": 41.558394272381754, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7639439322313872, - -0.6435651516167491, - -0.04704852847173397, - -5.690497564800579 - ], - [ - 0.6440521879096948, - 0.7649582835894266, - -0.005966876624543756, - -0.15929986659203993 - ], - [ - 0.03983023544469885, - -0.025743348508458348, - 0.9988747831194814, - -0.20924548851933628 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6454, - "backend_objective": 387.4586231892055, - "backend_elapsed_sec": 0.14775019999797223, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3662, - "objective": 793.4013599960855 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5597, - "objective": 454.3374059513834 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6454, - "objective": 387.4586231892055 - } - ], - "heldout_symmetric": { - "evaluated": 7836, - "inliers": 4678, - "inlier_ratio": 0.5969882593159775, - "inlier_rmse_m": 0.11948988234049264, - "median_m": 0.16994191818534032, - "p90_m": 1.3871349397174513, - "p95_m": 1.97156377761898 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22006.259658114905, - 34479.6469759605, - 86857.51803611554, - 106648.36352344266, - 574375.0921400371, - 855949.7206069975 - ], - "effective_rank": 6, - "scaled_condition_number": 38.89573848099908, - "weakest_scaled_direction": [ - -0.24410129675445133, - -0.6412594673328811, - -0.017288559314885304, - 0.08167125127345896, - -0.3695714866978811, - -0.6210061844546367 - ] - }, - "forward_reverse": { - "translation_m": 0.0030407162313759195, - "rotation_deg": 0.04107484998318919 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.934014815290038e-16, - "rotation_deg": 2.3147404516544623e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 14121, - "frame_counter_j": 17319, - "rtk_translation_m": 4.718056434111957, - "rtk_rotation_deg": 39.84834438838189, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7614272893352313, - -0.640948125804425, - -0.09702568259691158, - 0.632360932908526 - ], - [ - 0.638231778556938, - 0.7674274197816172, - -0.060953689038292125, - 5.411755178510274 - ], - [ - 0.11352832199785706, - -0.015513071750118472, - 0.993413642300742, - 0.45109623683849287 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7053, - "backend_objective": 606.2211604299207, - "backend_elapsed_sec": 0.18138240000553196, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3613, - "objective": 1268.5302830646299 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5598, - "objective": 476.97255540118505 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7053, - "objective": 606.2211604299207 - } - ], - "heldout_symmetric": { - "evaluated": 7926, - "inliers": 4706, - "inlier_ratio": 0.593742114559677, - "inlier_rmse_m": 0.12239484647700946, - "median_m": 0.173173374832085, - "p90_m": 1.45663494349597, - "p95_m": 2.2943876589320324 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14877.427885505398, - 35787.07295867024, - 50884.973292792594, - 209675.95350943724, - 545710.4682208394, - 696425.7673018099 - ], - "effective_rank": 6, - "scaled_condition_number": 46.81089854115947, - "weakest_scaled_direction": [ - -0.15847095089853475, - -0.6320286374681653, - 0.00467033473706568, - 0.10005335854687088, - -0.004085013041242569, - 0.7519159429263597 - ] - }, - "forward_reverse": { - "translation_m": 0.035258275490363276, - "rotation_deg": 0.11274694382482037 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.9731757487447026e-15, - "rotation_deg": 1.430055308174335e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784255459.889231, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 14121, - "frame_counter_j": 19292, - "rtk_translation_m": 4.0664516687652705, - "rtk_rotation_deg": 11.300244475855449, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9768282169550835, - -0.20652346544323266, - -0.056166651864516096, - 0.5983055995954767 - ], - [ - 0.20179303271347887, - 0.9761683262383832, - -0.07984341423843572, - 4.240156797143145 - ], - [ - 0.0713176451423399, - 0.06665926094903443, - 0.9952237619857557, - 0.2869858106461779 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7267, - "backend_objective": 900.8745292617994, - "backend_elapsed_sec": 0.15846639999654144, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4030, - "objective": 1144.1017722967904 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6249, - "objective": 663.0053216568518 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7267, - "objective": 900.8745292617994 - } - ], - "heldout_symmetric": { - "evaluated": 7968, - "inliers": 4903, - "inlier_ratio": 0.6153363453815262, - "inlier_rmse_m": 0.12504774785186165, - "median_m": 0.1687654969288034, - "p90_m": 1.251437072896233, - "p95_m": 2.094119368953069 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 28378.813774641414, - 49160.32657299357, - 101030.49698013302, - 336359.96562580095, - 579800.038339928, - 660582.2488608253 - ], - "effective_rank": 6, - "scaled_condition_number": 23.277303065116303, - "weakest_scaled_direction": [ - 0.24717054161315438, - -0.5903379150302325, - 0.01736850959359305, - 0.006963181916518798, - 0.19625232281300858, - 0.7426592382775639 - ] - }, - "forward_reverse": { - "translation_m": 0.0752860327247449, - "rotation_deg": 0.25939502405614967 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2676223177844214e-15, - "rotation_deg": 2.3294192564106242e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784255779.676285, - "frame_counter_i": 16041, - "frame_counter_j": 17319, - "rtk_translation_m": 8.48963239412477, - "rtk_rotation_deg": 1.7100498839998592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9968820778250913, - 0.003346152110590771, - -0.07883480308328725, - 8.44727189678211 - ], - [ - -0.003238298341620218, - 0.9999936378283393, - 0.0014959033037749785, - 0.16985217996209317 - ], - [ - 0.07883930704273438, - -0.0012359485816060569, - 0.9968865713290177, - 0.3323125395542791 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6061, - "backend_objective": 296.06552764191895, - "backend_elapsed_sec": 0.13779710000380874, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3341, - "objective": 1042.3225491589421 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5213, - "objective": 466.4957431029522 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6061, - "objective": 296.06552764191895 - } - ], - "heldout_symmetric": { - "evaluated": 8050, - "inliers": 4740, - "inlier_ratio": 0.5888198757763975, - "inlier_rmse_m": 0.12435475144629402, - "median_m": 0.1765071676688844, - "p90_m": 1.6337250851465148, - "p95_m": 2.9124972812328584 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 12025.310920278669, - 25203.800524971048, - 32520.493482821556, - 51463.82133473451, - 481306.6124908726, - 621586.1951270455 - ], - "effective_rank": 6, - "scaled_condition_number": 51.68982317778118, - "weakest_scaled_direction": [ - 0.951506919003375, - 0.13958470848199878, - -0.0686086484447313, - 0.013035436431537316, - 0.06482321491494214, - 0.25704391416724515 - ] - }, - "forward_reverse": { - "translation_m": 0.008996147539897087, - "rotation_deg": 0.2187503499467401 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2065345846865554e-14, - "rotation_deg": 3.167404076123598e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 16041, - "frame_counter_j": 19292, - "rtk_translation_m": 7.8510898708654135, - "rtk_rotation_deg": 30.258149796526293, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8784882023592437, - 0.47255141552220853, - -0.07038208581436586, - 7.664207659033369 - ], - [ - -0.47508739932589433, - 0.8796074650640061, - -0.024138566764228903, - -0.6768859748144646 - ], - [ - 0.050501894195978, - 0.054643088232915055, - 0.997228003814067, - 0.28520544876888726 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 5812, - "backend_objective": 370.7202511401026, - "backend_elapsed_sec": 0.13546130000031553, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3543, - "objective": 1428.8916380345797 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5218, - "objective": 536.6081017090486 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 5812, - "objective": 370.7202511401026 - } - ], - "heldout_symmetric": { - "evaluated": 8092, - "inliers": 4470, - "inlier_ratio": 0.5523974295600593, - "inlier_rmse_m": 0.12600876663407296, - "median_m": 0.20286419905782896, - "p90_m": 1.6147468325603878, - "p95_m": 2.805047213360247 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21684.657524579143, - 27610.239802724915, - 30903.735216019497, - 52455.37828031484, - 417310.19644627685, - 521304.1624242548 - ], - "effective_rank": 6, - "scaled_condition_number": 24.040230371790127, - "weakest_scaled_direction": [ - 0.8912524959464948, - 0.3642347728180668, - -0.06634917877038578, - -0.12486161661730673, - 0.206618349139099, - -0.1015787365079721 - ] - }, - "forward_reverse": { - "translation_m": 0.0067913142930030295, - "rotation_deg": 0.19210976651930364 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.551115123125783e-17, - "rotation_deg": 7.393555898627807e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784255651.8811028, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 16041, - "frame_counter_j": 20886, - "rtk_translation_m": 7.303425556850936, - "rtk_rotation_deg": 93.89697482620899, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.020445712902994198, - 0.9969178171880968, - 0.07574192100025015, - 4.704421015324436 - ], - [ - -0.9991966284753122, - -0.017763043350054266, - -0.035924531096634855, - -5.440060124383551 - ], - [ - -0.034468398098219305, - -0.07641557474666981, - 0.9964800998859328, - -0.10522201791472277 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5428, - "backend_objective": 351.79254183723884, - "backend_elapsed_sec": 0.12306160000298405, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3576, - "objective": 1501.3695690149013 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4848, - "objective": 560.7525113597009 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5428, - "objective": 351.79254183723884 - } - ], - "heldout_symmetric": { - "evaluated": 7986, - "inliers": 3883, - "inlier_ratio": 0.48622589531680444, - "inlier_rmse_m": 0.12387372192061825, - "median_m": 0.2691194377104539, - "p90_m": 1.7533827718302937, - "p95_m": 2.5603841235045555 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 13699.262425009529, - 25031.34692415126, - 32048.16004978538, - 51106.55986650569, - 323714.4342572996, - 550126.0010622512 - ], - "effective_rank": 6, - "scaled_condition_number": 40.15734453396082, - "weakest_scaled_direction": [ - 0.9566278035094122, - -0.15101904271519942, - -0.01805979052063306, - 0.162387693893328, - 0.10336288013185078, - 0.15708816040474904 - ] - }, - "forward_reverse": { - "translation_m": 0.010457065237222635, - "rotation_deg": 0.051939983599844905 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 0.0, - "rotation_deg": 1.114862484459897e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784255976.968491, - "frame_counter_i": 17319, - "frame_counter_j": 19292, - "rtk_translation_m": 0.684356309096518, - "rtk_rotation_deg": 28.54809991252644, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8816289368915158, - 0.4719407933990793, - 0.0015182757927952675, - -0.772768822140439 - ], - [ - -0.4717156823981689, - 0.8812991782284366, - -0.028214773320228582, - -0.8768630546211953 - ], - [ - -0.014653757714838437, - 0.024158766105281185, - 0.999600730994683, - -0.04998065168532363 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 9333, - "backend_objective": 2815.4080358929373, - "backend_elapsed_sec": 0.12336150000191992, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4340, - "objective": 820.4919752049427 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7199, - "objective": 966.9601913448714 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 9333, - "objective": 2815.4080358929373 - } - ], - "heldout_symmetric": { - "evaluated": 8182, - "inliers": 6612, - "inlier_ratio": 0.8081153752138841, - "inlier_rmse_m": 0.09827968392237502, - "median_m": 0.08304453177002662, - "p90_m": 0.5517982548079018, - "p95_m": 1.0106194516226792 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 82014.63663148035, - 99971.71061275335, - 385846.1542163829, - 822533.6764721328, - 929348.7058243885, - 1154309.236244329 - ], - "effective_rank": 6, - "scaled_condition_number": 14.074429682972724, - "weakest_scaled_direction": [ - -0.05493835664601167, - -0.2190834088147699, - 0.04163614590087344, - 0.5408135568451441, - -0.7851204582501254, - 0.1958500218924532 - ] - }, - "forward_reverse": { - "translation_m": 0.003170825002365958, - "rotation_deg": 0.052994059649638055 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.09819853533785e-16, - "rotation_deg": 8.280792483131434e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 17319, - "frame_counter_j": 20886, - "rtk_translation_m": 4.983180422136547, - "rtk_rotation_deg": 92.18692494220912, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.01934643839387679, - 0.9883143426290043, - 0.15119681040045624, - -3.7409060376281773 - ], - [ - -0.9993804976719116, - -0.014668882759877908, - -0.031991323067661, - -5.628899077198521 - ], - [ - -0.029399595142015688, - -0.1517220617852807, - 0.9879858702294831, - -0.0993579951968997 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5301, - "backend_objective": 421.88848952036983, - "backend_elapsed_sec": 0.10061359999963315, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3511, - "objective": 3395.766710226065 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 4581, - "objective": 431.97391171637895 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5301, - "objective": 421.88848952036983 - } - ], - "heldout_symmetric": { - "evaluated": 8076, - "inliers": 3961, - "inlier_ratio": 0.4904655770183259, - "inlier_rmse_m": 0.13065086109778945, - "median_m": 0.26231861756437486, - "p90_m": 1.5907333674407091, - "p95_m": 2.345202167351 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 8193.9069015766, - 18562.62121499715, - 26317.728799724886, - 80057.68428409971, - 372802.1393483318, - 491217.91826597735 - ], - "effective_rank": 6, - "scaled_condition_number": 59.94917005604024, - "weakest_scaled_direction": [ - 0.7151299851410865, - -0.14260326155762948, - -0.0012777951784502825, - 0.05204470271819456, - 0.032170738555938584, - 0.6815483650368894 - ] - }, - "forward_reverse": { - "translation_m": 0.03026165336674197, - "rotation_deg": 0.022229096602302635 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.542766177132399e-15, - "rotation_deg": 1.61652701750403e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784255779.676285, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 17319, - "frame_counter_j": 22408, - "rtk_translation_m": 7.513058208926106, - "rtk_rotation_deg": 116.17598776756182, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.47008278937912884, - 0.8778104406830235, - 0.09203804298991175, - -4.922075066208368 - ], - [ - -0.8826162312832012, - -0.46790429627745816, - -0.045322817658813346, - -8.02822556150332 - ], - [ - 0.003280153193869819, - -0.10253974718601387, - 0.9947234996932834, - -0.05208095772954405 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 6355, - "backend_objective": 461.9280140750825, - "backend_elapsed_sec": 0.1332812999971793, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3770, - "objective": 2641.7568706749053 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5402, - "objective": 542.5294248550516 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 6355, - "objective": 461.9280140750825 - } - ], - "heldout_symmetric": { - "evaluated": 8181, - "inliers": 4502, - "inlier_ratio": 0.5502994743918836, - "inlier_rmse_m": 0.13363854913882675, - "median_m": 0.2098237832216049, - "p90_m": 1.5443271950839803, - "p95_m": 2.5433742955069607 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 9064.01076040138, - 17288.375253654736, - 23152.337927605346, - 59388.591356263074, - 386412.1696285849, - 694262.6915440422 - ], - "effective_rank": 6, - "scaled_condition_number": 76.59552817138297, - "weakest_scaled_direction": [ - 0.7999959798950883, - 0.09984954399240337, - 0.00036443859253461536, - 0.04505649545756605, - 0.08394900200691098, - 0.5839168135786503 - ] - }, - "forward_reverse": { - "translation_m": 0.012728663920096705, - "rotation_deg": 0.13777836936248603 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9081537956177416e-06, - "rotation_deg": 7.024559753171988e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256136.3617284, - "frame_counter_i": 19292, - "frame_counter_j": 20886, - "rtk_translation_m": 4.470221622128888, - "rtk_rotation_deg": 63.638825029682685, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.45518795507953536, - 0.8806757181259877, - 0.13120291556892832, - -0.36313149768144026 - ], - [ - -0.8903849852351291, - 0.4509256960348763, - 0.062294419680266055, - -5.5873959212174364 - ], - [ - -0.00430158323756421, - -0.14517677554877292, - 0.9893963817514753, - 0.07504021975377846 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5969, - "backend_objective": 582.3495415951427, - "backend_elapsed_sec": 0.09732400000211783, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3742, - "objective": 960.705249387963 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5274, - "objective": 651.0741821680006 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5969, - "objective": 582.3495415951427 - } - ], - "heldout_symmetric": { - "evaluated": 8118, - "inliers": 4379, - "inlier_ratio": 0.5394185760039418, - "inlier_rmse_m": 0.1291861812905223, - "median_m": 0.2136111190065929, - "p90_m": 1.3583261301567073, - "p95_m": 2.241200695618558 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 13601.402435277021, - 29710.530981642187, - 50933.425160137616, - 113590.97287487936, - 370481.6535213091, - 546630.7470390503 - ], - "effective_rank": 6, - "scaled_condition_number": 40.18929295270992, - "weakest_scaled_direction": [ - 0.7236918442396623, - -0.12612452493424942, - -0.011484351344022353, - 0.059268710695743895, - 0.035077552263414476, - 0.6748982247161309 - ] - }, - "forward_reverse": { - "translation_m": 0.016569656651710556, - "rotation_deg": 0.06971243680146068 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2803286093439427e-15, - "rotation_deg": 1.338489262522533e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 19292, - "frame_counter_j": 22408, - "rtk_translation_m": 7.042432348069883, - "rtk_rotation_deg": 87.62788785503537, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0021825602459423915, - 0.9965174217262625, - 0.08335625127615602, - -0.27035351318353673 - ], - [ - -0.9997594529601681, - 0.0003552983574428027, - 0.021929659820922733, - -8.2574392105335 - ], - [ - 0.021823671724918947, - -0.0833840629803923, - 0.9962784878703972, - 0.17865309723463324 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 6828, - "backend_objective": 618.3271427110077, - "backend_elapsed_sec": 0.14201709999906598, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3996, - "objective": 1228.2353648877847 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5863, - "objective": 678.370898560891 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 6828, - "objective": 618.3271427110077 - } - ], - "heldout_symmetric": { - "evaluated": 8223, - "inliers": 4801, - "inlier_ratio": 0.5838501763346711, - "inlier_rmse_m": 0.13149007038687927, - "median_m": 0.1903804643804301, - "p90_m": 1.492440437688632, - "p95_m": 2.4095908597286577 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15224.46877742388, - 25661.420755718398, - 55955.135342324895, - 92990.06425696622, - 413111.30713994784, - 710685.3921925274 - ], - "effective_rank": 6, - "scaled_condition_number": 46.68047224389145, - "weakest_scaled_direction": [ - -0.7147631663185814, - -0.3634431411400236, - -0.0035810558926622927, - 0.10600915602096195, - 0.004510329742552284, - -0.5880064549276128 - ] - }, - "forward_reverse": { - "translation_m": 0.016475747103725697, - "rotation_deg": 0.027479170527625274 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.910174132484935e-06, - "rotation_deg": 1.9207746396590128e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784255976.968491, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 19292, - "frame_counter_j": 23318, - "rtk_translation_m": 9.425648786798952, - "rtk_rotation_deg": 64.11974003309916, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.43802168063953767, - 0.8944346955775235, - 0.09013091942756407, - 0.7162844958272518 - ], - [ - -0.8989628537937877, - 0.43600026852598744, - 0.042066059290080456, - -10.419630433030505 - ], - [ - -0.0016717621376428867, - -0.09945019453178437, - 0.995041136847591, - 0.31598650657026534 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 5715, - "backend_objective": 445.5765295317542, - "backend_elapsed_sec": 0.13727279999875464, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3622, - "objective": 1162.8288410869952 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 5071, - "objective": 751.2096302588283 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 5715, - "objective": 445.5765295317542 - } - ], - "heldout_symmetric": { - "evaluated": 8141, - "inliers": 4171, - "inlier_ratio": 0.512344920771404, - "inlier_rmse_m": 0.13771827771927672, - "median_m": 0.23951514008571945, - "p90_m": 1.7401790146448117, - "p95_m": 2.772253200651671 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 7395.011220108009, - 15446.339397939639, - 29060.010489087173, - 54379.005833971976, - 310590.6312192472, - 614385.0936254476 - ], - "effective_rank": 6, - "scaled_condition_number": 83.08102250810028, - "weakest_scaled_direction": [ - 0.7772460922681672, - -0.01813981289306854, - -0.0025211633766067296, - 0.03534264049542607, - 0.036069928634827435, - 0.6268994823641082 - ] - }, - "forward_reverse": { - "translation_m": 0.1594220156320846, - "rotation_deg": 0.7727589642419826 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2959208739370123e-15, - "rotation_deg": 1.5971584200687242e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256288.555478, - "frame_counter_i": 20886, - "frame_counter_j": 22408, - "rtk_translation_m": 2.6059162757855927, - "rtk_rotation_deg": 23.989062825352686, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8912343738314886, - 0.4535319654347207, - 0.003169736600035322, - 2.421687989858907 - ], - [ - -0.45294035737404276, - 0.8903885050132939, - -0.04531382572754398, - -1.1587659836890734 - ], - [ - -0.02337356547617081, - 0.03894953746979527, - 0.9989677722368325, - 0.0420823939863406 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 7630, - "backend_objective": 1455.303960542742, - "backend_elapsed_sec": 0.1647997000036412, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4426, - "objective": 1313.7031765388956 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6680, - "objective": 849.3108750728281 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 7630, - "objective": 1455.303960542742 - } - ], - "heldout_symmetric": { - "evaluated": 8117, - "inliers": 5427, - "inlier_ratio": 0.6685967722064802, - "inlier_rmse_m": 0.11944947118678222, - "median_m": 0.14378616058602978, - "p90_m": 0.8842570158395386, - "p95_m": 1.229203482110631 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 46765.544228026156, - 80793.54981191776, - 149884.31382019675, - 265394.9845172282, - 505846.5961876668, - 818127.7305801059 - ], - "effective_rank": 6, - "scaled_condition_number": 17.494241627788213, - "weakest_scaled_direction": [ - 0.04867092585785047, - -0.1575387586342452, - 0.005987515417252639, - 0.8374697852706786, - 0.5185638422497113, - -0.05012714267887746 - ] - }, - "forward_reverse": { - "translation_m": 0.00889966253307221, - "rotation_deg": 0.1868503363813343 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.309780215592113e-07, - "rotation_deg": 3.3115878200538718e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 20886, - "frame_counter_j": 23318, - "rtk_translation_m": 4.985522367267706, - "rtk_rotation_deg": 0.4809150034164723, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9998023060760732, - 0.01976036213739393, - -0.002208359836026279, - 4.820338500008935 - ], - [ - -0.019823432056912265, - 0.9992389047447424, - -0.03359527922213463, - -1.2706565755670578 - ], - [ - 0.001542824180296927, - 0.03363241491072646, - 0.9994330794809728, - 0.04749694736072386 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 7375, - "backend_objective": 961.1249598514407, - "backend_elapsed_sec": 0.15755589999753283, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4178, - "objective": 942.548118973746 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6222, - "objective": 826.5152620069694 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 7375, - "objective": 961.1249598514407 - } - ], - "heldout_symmetric": { - "evaluated": 8035, - "inliers": 5127, - "inlier_ratio": 0.6380833851897947, - "inlier_rmse_m": 0.12132550246856395, - "median_m": 0.15770625805094865, - "p90_m": 1.0105183714882358, - "p95_m": 1.4443938375355427 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38220.47822724542, - 74192.62410794286, - 133171.8151269444, - 185356.25081268084, - 512375.02921205445, - 737086.3171991681 - ], - "effective_rank": 6, - "scaled_condition_number": 19.285114979899365, - "weakest_scaled_direction": [ - 0.011324376957745776, - 0.11235035926494373, - -0.0009444747378392497, - -0.9878526280648751, - -0.10568876107911156, - 0.015011136995866018 - ] - }, - "forward_reverse": { - "translation_m": 0.011310526444604854, - "rotation_deg": 0.11618951108877962 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.427794399111402e-15, - "rotation_deg": 2.7055481326957747e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784256136.3617284, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 20886, - "frame_counter_j": 24870, - "rtk_translation_m": 5.330126890587504, - "rtk_rotation_deg": 0.570225046299944, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999522007230719, - -0.0026049193654290336, - 0.00942394101135911, - -5.324303283700147 - ], - [ - 0.003322840708574443, - 0.9970266672774769, - -0.07698560558438003, - -0.3752017394440634 - ], - [ - -0.009195379204328873, - 0.07701323998292689, - 0.996987665855812, - -0.05706909380340966 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 5639, - "backend_objective": 513.670596852096, - "backend_elapsed_sec": 0.15019320000283187, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3476, - "objective": 828.8592863122066 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 4958, - "objective": 505.0197716476575 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 5639, - "objective": 513.670596852096 - } - ], - "heldout_symmetric": { - "evaluated": 7978, - "inliers": 4064, - "inlier_ratio": 0.5094008523439458, - "inlier_rmse_m": 0.12969283093489314, - "median_m": 0.23871269787212862, - "p90_m": 2.5595252487569766, - "p95_m": 4.831947998817693 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 27411.22938276199, - 38474.070805716256, - 63895.302152855875, - 75112.7797121055, - 339625.5586139107, - 638346.6953072507 - ], - "effective_rank": 6, - "scaled_condition_number": 23.287780580490335, - "weakest_scaled_direction": [ - -0.009584146992439467, - 0.16279417906655858, - -0.009399205231237984, - -0.9830437940095708, - -0.0811894714868599, - 0.018735610703872106 - ] - }, - "forward_reverse": { - "translation_m": 0.01929138406979036, - "rotation_deg": 0.6381307294537529 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.310252409044606e-15, - "rotation_deg": 4.835073897325631e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256379.5515926, - "frame_counter_i": 22408, - "frame_counter_j": 23318, - "rtk_translation_m": 2.3845573265941185, - "rtk_rotation_deg": 23.508147821936216, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8998499359291912, - -0.4359398958188749, - -0.015049918327306625, - 2.1827399823027336 - ], - [ - 0.4361516727459754, - 0.8997268215880295, - 0.016228520449798337, - 0.9782555530946961 - ], - [ - 0.006466155667607454, - -0.02116728014012171, - 0.9997550375378721, - 0.08740740255199607 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 9014, - "backend_objective": 1875.867732651144, - "backend_elapsed_sec": 0.17852779999520862, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4496, - "objective": 957.8888237731599 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7157, - "objective": 843.154578030835 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 9014, - "objective": 1875.867732651144 - } - ], - "heldout_symmetric": { - "evaluated": 8140, - "inliers": 6443, - "inlier_ratio": 0.7915233415233415, - "inlier_rmse_m": 0.11297936021484274, - "median_m": 0.10706160747447739, - "p90_m": 0.507390407485888, - "p95_m": 0.839560107644622 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 63475.17710631269, - 184662.16835054953, - 298957.8130093707, - 385573.67462821543, - 687267.7766717601, - 939588.3475754261 - ], - "effective_rank": 6, - "scaled_condition_number": 14.802453343324077, - "weakest_scaled_direction": [ - 0.006854375946953913, - 0.10286850498345976, - -0.00027346378593445027, - -0.988236033300316, - -0.1112698302983711, - 0.01948283302376861 - ] - }, - "forward_reverse": { - "translation_m": 0.04714013527415902, - "rotation_deg": 0.5990777245962995 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0751942408233176e-06, - "rotation_deg": 7.548486444932098e-06 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 22408, - "frame_counter_j": 24870, - "rtk_translation_m": 7.871327660405588, - "rtk_rotation_deg": 24.55928787165262, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8897389682057136, - -0.45646966552081075, - -0.00011364661203049606, - -7.263239507289757 - ], - [ - 0.45642610077844487, - 0.8896574379624367, - -0.013596235004545161, - -2.84864546956515 - ], - [ - 0.0063073753985592295, - 0.012045228824430657, - 0.9999075604665406, - -0.20440460266109475 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6063, - "backend_objective": 496.26452336902076, - "backend_elapsed_sec": 0.12041150000004563, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3580, - "objective": 1062.5168745589585 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5268, - "objective": 546.8445311304296 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6063, - "objective": 496.26452336902076 - } - ], - "heldout_symmetric": { - "evaluated": 8083, - "inliers": 4168, - "inlier_ratio": 0.515650129902264, - "inlier_rmse_m": 0.1258655742770286, - "median_m": 0.22919793596086796, - "p90_m": 2.594510357876042, - "p95_m": 4.609535834861499 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26952.66917035411, - 29416.308782956065, - 66005.3484185413, - 87336.038605321, - 435785.59407900745, - 754379.7461924974 - ], - "effective_rank": 6, - "scaled_condition_number": 27.98905523695805, - "weakest_scaled_direction": [ - -0.44578870702799445, - -0.16089455629693108, - -0.0008692493253782343, - -0.8468223651522725, - -0.11955307695258373, - -0.2097225751201181 - ] - }, - "forward_reverse": { - "translation_m": 0.019790578845351906, - "rotation_deg": 0.2492103704468241 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.044890973928333e-15, - "rotation_deg": 1.140017152611419e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784256288.555478, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 22408, - "frame_counter_j": 26309, - "rtk_translation_m": 6.334147330965719, - "rtk_rotation_deg": 0.13339551798522414, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9994207853807073, - -0.03403061736672444, - -0.00010407041614550044, - -5.632055419098489 - ], - [ - 0.03402998215382529, - 0.9994136784232563, - -0.003776201147663733, - -2.8984852324305423 - ], - [ - 0.0002325158537709441, - 0.0037704724023494385, - 0.9999928647116642, - -0.17147294877222133 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 6811, - "backend_objective": 558.3449670113622, - "backend_elapsed_sec": 0.12805240000307094, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3949, - "objective": 1092.2180210764654 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5854, - "objective": 726.1879158222547 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 6811, - "objective": 558.3449670113622 - } - ], - "heldout_symmetric": { - "evaluated": 8094, - "inliers": 4870, - "inlier_ratio": 0.6016802569804793, - "inlier_rmse_m": 0.12195151942370595, - "median_m": 0.17018616284477028, - "p90_m": 1.5016146147157554, - "p95_m": 2.43761714609227 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32895.66665628805, - 56729.74298723965, - 78566.09972291421, - 122496.81698787458, - 473650.18726381595, - 850395.274878842 - ], - "effective_rank": 6, - "scaled_condition_number": 25.851285634799194, - "weakest_scaled_direction": [ - 0.11854872697857118, - -0.03620123735838449, - -0.0025408098341967787, - 0.8487231630819442, - 0.5013704778655587, - -0.1136919100196249 - ] - }, - "forward_reverse": { - "translation_m": 0.01939980613812204, - "rotation_deg": 0.1992615163030762 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0747845227977221e-06, - "rotation_deg": 9.805747437173149e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256534.7457418, - "frame_counter_i": 23318, - "frame_counter_j": 24870, - "rtk_translation_m": 10.188241681839806, - "rtk_rotation_deg": 1.051140049716416, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9997015544383775, - -0.0227703234527983, - 0.008849543680213989, - -10.167954486452267 - ], - [ - 0.02300643122017748, - 0.9993552780301788, - -0.02756324356339905, - 0.6789456214353665 - ], - [ - -0.008216214213633602, - 0.027758613853702388, - 0.9995808887633443, - -0.1859319993162138 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5563, - "backend_objective": 490.410389492314, - "backend_elapsed_sec": 0.11604739999893354, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3523, - "objective": 1267.0238186870702 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5048, - "objective": 544.0615864072715 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5563, - "objective": 490.410389492314 - } - ], - "heldout_symmetric": { - "evaluated": 8001, - "inliers": 3673, - "inlier_ratio": 0.4590676165479315, - "inlier_rmse_m": 0.13331101566670972, - "median_m": 0.3002196892764815, - "p90_m": 3.2581372835342717, - "p95_m": 5.855203764788552 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 17239.11913109965, - 20134.699454305603, - 37235.73050760069, - 45146.73572292974, - 387505.0132568977, - 644086.0923223444 - ], - "effective_rank": 6, - "scaled_condition_number": 37.36189113980903, - "weakest_scaled_direction": [ - -0.6503648348618848, - -0.6445334681821625, - -0.000915705696581413, - 0.3989053307308535, - -0.038593786894989164, - -0.03140713579485332 - ] - }, - "forward_reverse": { - "translation_m": 0.03193705319987942, - "rotation_deg": 0.25820325147713563 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7240086067659812e-15, - "rotation_deg": 1.0876152380957797e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 23318, - "frame_counter_j": 26309, - "rtk_translation_m": 8.639041695194567, - "rtk_rotation_deg": 23.641543339921444, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9141296132676869, - 0.40540459081847563, - 0.0037640258200782443, - -8.729538276191489 - ], - [ - -0.40527531604148775, - 0.9140091249072223, - -0.018418409100883965, - -0.08240811068789908 - ], - [ - -0.010907261551009044, - 0.01531134643457656, - 0.9998232815432031, - -0.1677894599953628 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6220, - "backend_objective": 485.1828054284849, - "backend_elapsed_sec": 0.1345738000018173, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3860, - "objective": 1376.345055039893 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5582, - "objective": 600.1045801253993 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6220, - "objective": 485.1828054284849 - } - ], - "heldout_symmetric": { - "evaluated": 8012, - "inliers": 4318, - "inlier_ratio": 0.5389415876185721, - "inlier_rmse_m": 0.1297159188720241, - "median_m": 0.21542729412300382, - "p90_m": 1.79522367477362, - "p95_m": 3.0549286044438078 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26867.028071381184, - 32559.91926414736, - 57105.321576312854, - 136203.58156358713, - 430514.28084125667, - 640133.7159173073 - ], - "effective_rank": 6, - "scaled_condition_number": 23.825996467364362, - "weakest_scaled_direction": [ - -0.15565619986656173, - -0.053000344596286206, - 0.004079505504695158, - -0.84397432606044, - -0.5062837370845512, - 0.06579956736286026 - ] - }, - "forward_reverse": { - "translation_m": 0.007152603768137945, - "rotation_deg": 0.01099978555369691 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8393560444588434e-15, - "rotation_deg": 8.610987100606946e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784256379.5515926, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 23318, - "frame_counter_j": 27507, - "rtk_translation_m": 9.620687246763701, - "rtk_rotation_deg": 76.25281000098852, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.23122414908690103, - 0.9728430859471087, - -0.010569910309299494, - -10.53220655051897 - ], - [ - -0.9725641353396981, - 0.23084490064683996, - -0.028803376473888875, - -0.6857073012760646 - ], - [ - -0.025581155759358123, - 0.016939951896586636, - 0.9995292104284682, - -0.2049621161786277 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 5773, - "backend_objective": 389.5330823366841, - "backend_elapsed_sec": 0.1376103000002331, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3753, - "objective": 1305.1642850813175 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5298, - "objective": 793.9817023332739 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 5773, - "objective": 389.5330823366841 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 4095, - "inlier_ratio": 0.5202642612120442, - "inlier_rmse_m": 0.13378678930694327, - "median_m": 0.23206551096779673, - "p90_m": 1.7500735778224101, - "p95_m": 3.1652207852718126 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15135.92291440619, - 19523.674572495456, - 33280.58301984846, - 55998.47622918941, - 428056.87787558854, - 601112.4117138004 - ], - "effective_rank": 6, - "scaled_condition_number": 39.71428865706424, - "weakest_scaled_direction": [ - 0.061637737009855566, - -0.9430870672797075, - 0.014338657192172272, - 0.08144599518067594, - -0.08797749921695681, - -0.30365850114322496 - ] - }, - "forward_reverse": { - "translation_m": 0.023698091864950893, - "rotation_deg": 0.7026335973530661 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1157603309187458e-15, - "rotation_deg": 1.0243743084399812e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256678.6410081, - "frame_counter_i": 24870, - "frame_counter_j": 26309, - "rtk_translation_m": 1.5531467972267479, - "rtk_rotation_deg": 24.69268338963786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9044363112464162, - 0.42628595156270244, - -0.016590551505539543, - 1.4009909255190975 - ], - [ - -0.4260763097583071, - 0.9045665624974811, - 0.014775394215872682, - -0.7967529018346142 - ], - [ - 0.021305801128330634, - -0.006294562079480105, - 0.9997531902057167, - 0.02557907651542315 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8318, - "backend_objective": 1226.4357314653728, - "backend_elapsed_sec": 0.0907526999944821, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3999, - "objective": 856.6344537898987 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6763, - "objective": 802.3911942100771 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8318, - "objective": 1226.4357314653728 - } - ], - "heldout_symmetric": { - "evaluated": 7955, - "inliers": 5751, - "inlier_ratio": 0.7229415461973602, - "inlier_rmse_m": 0.10903876418375444, - "median_m": 0.11127819884612578, - "p90_m": 1.275765835923042, - "p95_m": 2.625185131735879 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43526.092959437425, - 166939.89896801452, - 247007.80834118306, - 351940.4048958493, - 489017.6219728073, - 1199812.8079664994 - ], - "effective_rank": 6, - "scaled_condition_number": 27.565368871601265, - "weakest_scaled_direction": [ - 0.06058538593233583, - -0.13122304280445923, - -0.0003200556366214719, - 0.8595594993709861, - 0.49016441932931015, - -0.0024760205205716025 - ] - }, - "forward_reverse": { - "translation_m": 0.004743603748938733, - "rotation_deg": 0.03110066538977425 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2673971694020647e-07, - "rotation_deg": 2.503289219925228e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 24870, - "frame_counter_j": 27507, - "rtk_translation_m": 0.5677742310084086, - "rtk_rotation_deg": 77.30395005070493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.20949209402632676, - 0.9776046592729533, - -0.02005474278761867, - -0.39943180660423966 - ], - [ - -0.9778103075794823, - 0.2094426755821079, - -0.004557196103580512, - -1.3508145960046476 - ], - [ - -0.00025481715653101207, - 0.02056443076821652, - 0.9997884972609941, - -0.025823220907427336 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 17, - "backend_num_inliers": 8752, - "backend_objective": 1267.0308744365327, - "backend_elapsed_sec": 0.1753374999971129, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3893, - "objective": 657.8714979714647 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6743, - "objective": 618.206373559294 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 17, - "num_inliers": 8752, - "objective": 1267.0308744365327 - } - ], - "heldout_symmetric": { - "evaluated": 7814, - "inliers": 5921, - "inlier_ratio": 0.75774251343742, - "inlier_rmse_m": 0.10672872147965808, - "median_m": 0.10413038435062855, - "p90_m": 1.2438161361772777, - "p95_m": 2.642259955999055 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51681.938196835385, - 152698.22419215602, - 290635.4781951394, - 344971.79948448204, - 611007.3561373402, - 1238394.0028664866 - ], - "effective_rank": 6, - "scaled_condition_number": 23.961833593584473, - "weakest_scaled_direction": [ - 0.1671609286104912, - -0.03380814500607621, - 0.008628386472209268, - 0.12451737579506356, - 0.9771999217521097, - -0.020384314484276942 - ] - }, - "forward_reverse": { - "translation_m": 0.00729627345064471, - "rotation_deg": 0.5370128665073076 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0056951509835115e-15, - "rotation_deg": 1.0112509993845629e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784256534.7457418, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 24870, - "frame_counter_j": 28833, - "rtk_translation_m": 2.9811390265794215, - "rtk_rotation_deg": 109.91770005034847, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3516100509209826, - 0.936098498658963, - -0.009485404565969911, - -2.0742082086392344 - ], - [ - -0.9354946822966979, - -0.35172523528106864, - -0.0337499372010806, - -4.222918296878955 - ], - [ - -0.03492952169646772, - -0.002993271606954244, - 0.9993852954887537, - -0.03765716569040032 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7061, - "backend_objective": 461.5914967971439, - "backend_elapsed_sec": 0.13223979999747826, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 3561, - "objective": 855.4107832390793 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5715, - "objective": 481.970772665258 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7061, - "objective": 461.5914967971439 - } - ], - "heldout_symmetric": { - "evaluated": 8000, - "inliers": 4995, - "inlier_ratio": 0.624375, - "inlier_rmse_m": 0.11606003815798548, - "median_m": 0.1514513869938955, - "p90_m": 1.73669221235636, - "p95_m": 2.735501950430222 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24129.59411319369, - 32373.47711729955, - 58841.203196575756, - 86898.58175112416, - 474491.536894069, - 1059981.8113939231 - ], - "effective_rank": 6, - "scaled_condition_number": 43.92870457834769, - "weakest_scaled_direction": [ - -0.16820235324262287, - -0.058954555725516763, - -0.029337447128326945, - 0.42166196222787367, - -0.8870000521426662, - 0.05295035436982381 - ] - }, - "forward_reverse": { - "translation_m": 0.00942822069733503, - "rotation_deg": 0.10349184268425643 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.951177265556479e-06, - "rotation_deg": 8.3073736616711e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784256798.4344501, - "frame_counter_i": 26309, - "frame_counter_j": 27507, - "rtk_translation_m": 0.98603936348044, - "rtk_rotation_deg": 52.61126666106708, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.606069659088095, - 0.7953353115219893, - -0.01101410818281325, - -1.4181672818254825 - ], - [ - -0.7953919806745632, - 0.6058994404442228, - -0.015409904216933229, - -1.2930373572591214 - ], - [ - -0.005582598985939911, - 0.018100008718228637, - 0.9998205960435915, - 0.006284302350749419 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 18, - "backend_num_inliers": 9279, - "backend_objective": 1350.0864027294872, - "backend_elapsed_sec": 0.22832729999936419, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4305, - "objective": 928.9119808234159 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7307, - "objective": 742.5261299257812 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 18, - "num_inliers": 9279, - "objective": 1350.0864027294872 - } - ], - "heldout_symmetric": { - "evaluated": 7825, - "inliers": 6288, - "inlier_ratio": 0.8035782747603833, - "inlier_rmse_m": 0.11258525838778834, - "median_m": 0.10649152428951339, - "p90_m": 0.4824433217202079, - "p95_m": 0.7187348662644616 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 114044.65342662529, - 167814.39297924298, - 246102.60193668984, - 327945.3644490077, - 637116.6102302462, - 1200476.8033071659 - ], - "effective_rank": 6, - "scaled_condition_number": 10.5263751279628, - "weakest_scaled_direction": [ - 0.14747807862713613, - -0.08533315159159649, - -0.032559037185622135, - 0.1420842862281211, - 0.973528604970575, - -0.044299995175285566 - ] - }, - "forward_reverse": { - "translation_m": 0.04456291633933312, - "rotation_deg": 0.40754887525204303 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.4685637307956015e-07, - "rotation_deg": 2.8482624120020845e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 26309, - "frame_counter_j": 28833, - "rtk_translation_m": 3.326868398717413, - "rtk_rotation_deg": 85.22501666071064, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0805970537397582, - 0.9967464671496635, - -0.0007714616877187484, - -1.7112669594199483 - ], - [ - -0.9954267280985057, - 0.08045047122955501, - -0.05151068496970481, - -4.599408656464984 - ], - [ - -0.05128102880770001, - 0.004919543028334273, - 0.9986721454916102, - -0.13783519795374166 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7276, - "backend_objective": 389.7841342653983, - "backend_elapsed_sec": 0.2591735999958473, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3742, - "objective": 727.0674970447593 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6101, - "objective": 540.928171170392 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7276, - "objective": 389.7841342653983 - } - ], - "heldout_symmetric": { - "evaluated": 8011, - "inliers": 5345, - "inlier_ratio": 0.667207589564349, - "inlier_rmse_m": 0.1151980232980854, - "median_m": 0.13680251069033955, - "p90_m": 1.2096575287808728, - "p95_m": 1.8798978631518177 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 25696.184216660444, - 43278.55282217451, - 69636.17037767288, - 77307.85375092001, - 533914.1107571747, - 972064.3096566651 - ], - "effective_rank": 6, - "scaled_condition_number": 37.82913063903142, - "weakest_scaled_direction": [ - 0.6579662022364344, - -0.6303457069498717, - 0.025792673895899905, - 0.03853891669204552, - 0.04852592483600396, - 0.4064966063040915 - ] - }, - "forward_reverse": { - "translation_m": 0.002550382605456025, - "rotation_deg": 0.05599236133477508 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2964317183584966e-06, - "rotation_deg": 9.824560554883892e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784256678.6410081, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 26309, - "frame_counter_j": 31809, - "rtk_translation_m": 1.702964560097507, - "rtk_rotation_deg": 146.95247656520317, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8389066296625791, - 0.542013322468758, - -0.04957040422017691, - -3.4126595415515117 - ], - [ - -0.5403613108943356, - -0.840315189779315, - -0.04335937631827396, - -2.046677450034886 - ], - [ - -0.06515612324815613, - -0.00958853964545765, - 0.9978290131634472, - -0.17386675507531454 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7675, - "backend_objective": 563.680367608485, - "backend_elapsed_sec": 0.3050522999983514, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3938, - "objective": 926.3826161605953 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 39, - "num_inliers": 6237, - "objective": 586.9855271664292 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7675, - "objective": 563.680367608485 - } - ], - "heldout_symmetric": { - "evaluated": 7919, - "inliers": 5303, - "inlier_ratio": 0.6696552595024624, - "inlier_rmse_m": 0.11181113630432839, - "median_m": 0.12891454710389022, - "p90_m": 1.0792229280660088, - "p95_m": 1.6212597913852251 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38885.37672557449, - 46766.506793335975, - 67701.82129714939, - 207094.99727869636, - 562627.9107866625, - 888110.0510721776 - ], - "effective_rank": 6, - "scaled_condition_number": 22.83917826847431, - "weakest_scaled_direction": [ - -0.9375052177352092, - 0.0012512210354023723, - -0.04853732487021837, - -0.05798338883222041, - -0.08446719282342695, - 0.32898290109925565 - ] - }, - "forward_reverse": { - "translation_m": 0.009851652453759501, - "rotation_deg": 0.030403861001117326 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.265177659758524e-15, - "rotation_deg": 1.81015934970548e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784256931.0294852, - "frame_counter_i": 27507, - "frame_counter_j": 28833, - "rtk_translation_m": 3.0423123591285863, - "rtk_rotation_deg": 32.61374999964355, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8413421306002993, - 0.5401749003199233, - 0.018828073223520547, - 2.4639065360594214 - ], - [ - -0.5400841987529208, - 0.8415510269801977, - -0.010046255321757389, - -2.240646045631129 - ], - [ - -0.021271519324330874, - -0.0017164069840244528, - 0.999772262274114, - 0.019164540125937404 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 8616, - "backend_objective": 956.7136686272877, - "backend_elapsed_sec": 0.1658876000001328, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3952, - "objective": 860.110565818336 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6630, - "objective": 536.257088215268 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 8616, - "objective": 956.7136686272877 - } - ], - "heldout_symmetric": { - "evaluated": 7870, - "inliers": 6141, - "inlier_ratio": 0.7803049555273189, - "inlier_rmse_m": 0.10890373850857962, - "median_m": 0.10440463421212016, - "p90_m": 0.6521983534195289, - "p95_m": 1.1734831393569933 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 78877.10288787694, - 84101.37575162206, - 160127.90957880375, - 254537.23538882803, - 650511.5411193318, - 1172660.2314165845 - ], - "effective_rank": 6, - "scaled_condition_number": 14.866928278077225, - "weakest_scaled_direction": [ - 0.38044677737671645, - -0.6175421178983382, - -0.007039238893102079, - 0.05928246961241466, - -0.02019697766183604, - 0.6855144799426871 - ] - }, - "forward_reverse": { - "translation_m": 0.0027074586252039488, - "rotation_deg": 0.03345524421318835 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0918664935034067e-15, - "rotation_deg": 5.8319512171970914e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 27507, - "frame_counter_j": 31809, - "rtk_translation_m": 1.0853574230860805, - "rtk_rotation_deg": 94.34120990413592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07741971445454904, - 0.9968329853313868, - -0.018171053054004932, - -0.5948194109933571 - ], - [ - -0.9962411393835493, - -0.07805835632561409, - -0.03755642698009, - -2.047537302412852 - ], - [ - -0.038855887759044465, - 0.015195142745589103, - 0.9991292847391665, - -0.014188698261691642 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 8982, - "backend_objective": 1031.9497940986337, - "backend_elapsed_sec": 0.1450198999955319, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4178, - "objective": 905.7123740483868 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6940, - "objective": 604.7334012217835 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 8982, - "objective": 1031.9497940986337 - } - ], - "heldout_symmetric": { - "evaluated": 7778, - "inliers": 6137, - "inlier_ratio": 0.7890203137053227, - "inlier_rmse_m": 0.110891959946164, - "median_m": 0.10733004926410059, - "p90_m": 0.5977894324849418, - "p95_m": 1.0190637764387274 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 113608.81247799078, - 137388.7251622544, - 157668.3128173131, - 368739.70217835915, - 689562.5789496836, - 1105520.5253335 - ], - "effective_rank": 6, - "scaled_condition_number": 9.73093989119612, - "weakest_scaled_direction": [ - 0.13897035899928514, - -0.23011712102442333, - -0.0017501649034986672, - 0.9420026575074658, - -0.028294637445202792, - 0.19889870184234165 - ] - }, - "forward_reverse": { - "translation_m": 0.07641393239305394, - "rotation_deg": 0.480643469622101 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.802499411511854e-08, - "rotation_deg": 3.4831950965669364e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784256798.4344501, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 27507, - "frame_counter_j": 32982, - "rtk_translation_m": 0.7190584934612743, - "rtk_rotation_deg": 134.43032499953063, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7066078605019434, - 0.7076025553036142, - 0.0019887696352553063, - -1.8783547815883113 - ], - [ - -0.7071630079772385, - -0.70606398998329, - -0.03733794581202542, - -0.33410637731292914 - ], - [ - -0.025016227242551092, - -0.02778967032321371, - 0.9993007168004414, - -0.11278262785455791 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9157, - "backend_objective": 1276.2856829565746, - "backend_elapsed_sec": 0.14711710000119638, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4466, - "objective": 991.5970034191695 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7207, - "objective": 729.2372529296415 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9157, - "objective": 1276.2856829565746 - } - ], - "heldout_symmetric": { - "evaluated": 7939, - "inliers": 6102, - "inlier_ratio": 0.7686106562539362, - "inlier_rmse_m": 0.1151576675189467, - "median_m": 0.11617967612489997, - "p90_m": 0.6930017744881233, - "p95_m": 1.1218970047072188 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 94377.40922866824, - 147328.99506129805, - 205058.68905170602, - 296714.34916519176, - 612921.4249016126, - 1050652.9192797944 - ], - "effective_rank": 6, - "scaled_condition_number": 11.132461972272983, - "weakest_scaled_direction": [ - -0.16382445094126535, - 0.3117324182312199, - -0.03642113344298442, - -0.7406798504082759, - -0.5589113022703062, - -0.11691648784462569 - ] - }, - "forward_reverse": { - "translation_m": 0.012325022302827005, - "rotation_deg": 0.06184414805686676 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.618159327614882e-07, - "rotation_deg": 7.653967189561823e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257228.6177175, - "frame_counter_i": 28833, - "frame_counter_j": 31809, - "rtk_translation_m": 1.9962827272376449, - "rtk_rotation_deg": 61.72745990449234, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.47405983570253, - 0.8803921908828962, - -0.013298962595058247, - -2.676558627239552 - ], - [ - -0.8799484001083862, - 0.47318180893348466, - -0.042305896056308676, - -1.4932989167082558 - ], - [ - -0.030952953338609267, - 0.03175792699232479, - 0.9990161904357543, - -0.15652381867717788 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 7939, - "backend_objective": 724.362552907716, - "backend_elapsed_sec": 0.13898329999938142, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4053, - "objective": 1103.0043457050915 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6453, - "objective": 732.6305423005572 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 7939, - "objective": 724.362552907716 - } - ], - "heldout_symmetric": { - "evaluated": 7964, - "inliers": 5739, - "inlier_ratio": 0.7206177800100452, - "inlier_rmse_m": 0.11075109929370276, - "median_m": 0.11674169176002847, - "p90_m": 0.8448943036529947, - "p95_m": 1.3485006575527223 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53196.94085196885, - 77289.81923132221, - 93789.88621040093, - 155088.22495762137, - 631621.5053000151, - 989101.7814746586 - ], - "effective_rank": 6, - "scaled_condition_number": 18.593207910714877, - "weakest_scaled_direction": [ - 0.8700876332541531, - 0.005438849005067692, - 0.021391655167415157, - 0.00020001566663914986, - 0.07587185938417014, - 0.4865220934512705 - ] - }, - "forward_reverse": { - "translation_m": 0.06755956873701982, - "rotation_deg": 0.6275145294718035 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.04530173519838e-13, - "rotation_deg": 8.841805729134826e-13 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 28833, - "frame_counter_j": 32982, - "rtk_translation_m": 3.133843614009462, - "rtk_rotation_deg": 101.81657499988698, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.21139845280798214, - 0.9773335280609319, - -0.011396011511219703, - -4.668912734372804 - ], - [ - -0.9761927103029002, - -0.21170231619465682, - -0.04722204643273404, - -0.7395876982291836 - ], - [ - -0.048564251274667236, - 0.001142035809473952, - 0.9988194077271135, - -0.12861696864920097 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7351, - "backend_objective": 488.62487431387007, - "backend_elapsed_sec": 0.11505949999991572, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4196, - "objective": 933.1511599683639 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6232, - "objective": 588.3144119308129 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7351, - "objective": 488.62487431387007 - } - ], - "heldout_symmetric": { - "evaluated": 8125, - "inliers": 5362, - "inlier_ratio": 0.6599384615384616, - "inlier_rmse_m": 0.1100348641166372, - "median_m": 0.1300534952824787, - "p90_m": 1.15707523134329, - "p95_m": 1.766562919039108 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35198.13650082762, - 59876.4310527085, - 67161.96486290553, - 84372.8901665409, - 475415.07895684836, - 876065.8125276816 - ], - "effective_rank": 6, - "scaled_condition_number": 24.889550971173787, - "weakest_scaled_direction": [ - -0.24853559297778208, - -0.9457866001968789, - -0.01841620000368909, - 0.11942057770516604, - 0.011973537234335146, - 0.1702174183663302 - ] - }, - "forward_reverse": { - "translation_m": 0.032753113036640115, - "rotation_deg": 0.1570816751009414 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.713178136967714e-16, - "rotation_deg": 3.0020579607741207e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784256931.0294852, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 28833, - "frame_counter_j": 34263, - "rtk_translation_m": 3.558853688535236, - "rtk_rotation_deg": 131.87013333415302, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6666776538665686, - 0.7440428249754553, - -0.0440588292798567, - -4.691613762087427 - ], - [ - -0.7424893929684974, - -0.6681315898209136, - -0.04805913037760015, - 1.4934678279557143 - ], - [ - -0.06519514678441221, - 0.0006732651198974303, - 0.9978723062345386, - -0.12271714611784558 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7165, - "backend_objective": 555.5199847082525, - "backend_elapsed_sec": 0.11779789999854984, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3942, - "objective": 840.9836300476868 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5774, - "objective": 506.1860228857608 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7165, - "objective": 555.5199847082525 - } - ], - "heldout_symmetric": { - "evaluated": 8196, - "inliers": 5208, - "inlier_ratio": 0.6354319180087847, - "inlier_rmse_m": 0.11655958277402616, - "median_m": 0.14914758057802308, - "p90_m": 1.43777364929328, - "p95_m": 2.103668776841584 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 27694.615021738682, - 44466.41914099572, - 53587.14482067487, - 93271.7755011132, - 484339.8456962315, - 975038.6663071899 - ], - "effective_rank": 6, - "scaled_condition_number": 35.20679617831266, - "weakest_scaled_direction": [ - 0.01627881312607319, - 0.9662667708280313, - 0.014539072572918454, - -0.09595928588899844, - -0.007676348113993425, - 0.2378760860969448 - ] - }, - "forward_reverse": { - "translation_m": 0.011678083327496752, - "rotation_deg": 0.14115606360994692 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.553994585222234e-15, - "rotation_deg": 1.0546339847493023e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257345.9129474, - "frame_counter_i": 31809, - "frame_counter_j": 32982, - "rtk_translation_m": 1.4312693216245356, - "rtk_rotation_deg": 40.08911509539463, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7604019020722598, - 0.6493722080538789, - 0.010231457966479857, - -1.6134657283805809 - ], - [ - -0.6494401338887195, - 0.760391113446228, - 0.005732982348479746, - -1.402360234017875 - ], - [ - -0.004057070308943698, - -0.011004090113958172, - 0.9999312227254793, - -0.05670028776703387 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9655, - "backend_objective": 1879.2346790786476, - "backend_elapsed_sec": 0.1040491000021575, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4646, - "objective": 823.4137505877958 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7751, - "objective": 776.5675575753061 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9655, - "objective": 1879.2346790786476 - } - ], - "heldout_symmetric": { - "evaluated": 8033, - "inliers": 6500, - "inlier_ratio": 0.8091622059006598, - "inlier_rmse_m": 0.10860060068735904, - "median_m": 0.10147851273927266, - "p90_m": 0.4927918143234507, - "p95_m": 1.0190216307481985 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 112992.99495667836, - 249180.74115089717, - 301009.0682656243, - 475185.405449173, - 819667.956188099, - 1112414.1625355538 - ], - "effective_rank": 6, - "scaled_condition_number": 9.844983425406634, - "weakest_scaled_direction": [ - -0.15186700772211661, - 0.1681460713290066, - -0.024209719120545443, - -0.7709595723834649, - -0.5946975220908758, - 0.0057788520946877074 - ] - }, - "forward_reverse": { - "translation_m": 0.004342811149796408, - "rotation_deg": 0.43079835067471983 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.421965320523987e-15, - "rotation_deg": 8.988391634638839e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 31809, - "frame_counter_j": 34263, - "rtk_translation_m": 2.8745434122269677, - "rtk_rotation_deg": 70.1426734296607, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3395701746102501, - 0.9405774397912682, - -0.0024852104270677556, - -3.5838725693478843 - ], - [ - -0.9401442183820569, - 0.33933091470425114, - -0.03135887384406664, - -0.3609309527687522 - ], - [ - -0.028652140547540124, - 0.012984994481281062, - 0.9995050999171364, - -0.09145728643956128 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8304, - "backend_objective": 1089.5017628855235, - "backend_elapsed_sec": 0.10852230000455165, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4398, - "objective": 931.1186130185138 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6816, - "objective": 622.1261644888319 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8304, - "objective": 1089.5017628855235 - } - ], - "heldout_symmetric": { - "evaluated": 8104, - "inliers": 5734, - "inlier_ratio": 0.7075518262586377, - "inlier_rmse_m": 0.11619246575360609, - "median_m": 0.1277335865652982, - "p90_m": 0.8869166569853159, - "p95_m": 1.34415324651648 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 99195.71528044977, - 110428.51303238966, - 188321.65339576546, - 237627.75369132202, - 585530.6198610035, - 1033314.5654917931 - ], - "effective_rank": 6, - "scaled_condition_number": 10.41692741032582, - "weakest_scaled_direction": [ - -0.4887104718737157, - -0.7194911031981126, - -0.04908498553608256, - -0.08997458923382402, - -0.41270050844045997, - 0.2503360839348684 - ] - }, - "forward_reverse": { - "translation_m": 0.03233653011234762, - "rotation_deg": 0.3501326921447133 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.7647268990566e-07, - "rotation_deg": 3.5143738747247757e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784257228.6177175, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 31809, - "frame_counter_j": 35181, - "rtk_translation_m": 2.368927629183393, - "rtk_rotation_deg": 88.7954400941961, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.02973354293484899, - 0.9993909753030981, - -0.01826458067582629, - -3.2432197669534153 - ], - [ - -0.9989795060814042, - 0.029089869023238867, - -0.0345503393552752, - 0.0060084083996273146 - ], - [ - -0.033997983085697306, - 0.019273245780954597, - 0.9992360477600735, - -0.0829704835859952 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8414, - "backend_objective": 979.5146627161371, - "backend_elapsed_sec": 0.13505730000179028, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4269, - "objective": 1161.1686857810428 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6804, - "objective": 740.8709704926232 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8414, - "objective": 979.5146627161371 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5767, - "inlier_ratio": 0.7127672722778395, - "inlier_rmse_m": 0.11187552234677736, - "median_m": 0.1189707970662154, - "p90_m": 0.8449576482857486, - "p95_m": 1.314180620706107 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 97192.98118662037, - 126449.98118380377, - 160019.36271354527, - 224482.6246777581, - 583151.8209709418, - 1058449.22034425 - ], - "effective_rank": 6, - "scaled_condition_number": 10.890181651202985, - "weakest_scaled_direction": [ - 0.27733316809094016, - 0.06472585483870608, - 0.052197604836843915, - 0.08537195858144588, - 0.9422562342552911, - -0.14504173653243188 - ] - }, - "forward_reverse": { - "translation_m": 0.0036477332397017036, - "rotation_deg": 0.03588537530780425 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.38285783479209e-07, - "rotation_deg": 2.5755614624241853e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257474.0083263, - "frame_counter_i": 32982, - "frame_counter_j": 34263, - "rtk_translation_m": 1.9888588003695142, - "rtk_rotation_deg": 30.053558334266054, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8687805366448252, - 0.49465660528258554, - 0.023134865407825958, - -2.178877273889968 - ], - [ - -0.49393201430707884, - 0.8689520727278436, - -0.030878156430341388, - -0.49173001883908807 - ], - [ - -0.03537717328562735, - 0.015399290642544214, - 0.999255381500658, - -0.008429632126379216 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8866, - "backend_objective": 1643.9809223431664, - "backend_elapsed_sec": 0.134610100001737, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4456, - "objective": 859.6899246249991 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7134, - "objective": 960.3920426695893 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8866, - "objective": 1643.9809223431664 - } - ], - "heldout_symmetric": { - "evaluated": 8265, - "inliers": 6159, - "inlier_ratio": 0.7451905626134301, - "inlier_rmse_m": 0.11103160300292489, - "median_m": 0.11345378163462407, - "p90_m": 0.6329249507351028, - "p95_m": 1.119741335680539 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 116288.82940152648, - 221407.49863204896, - 318065.78050281113, - 406857.997153302, - 644132.3497185204, - 1062747.9935378996 - ], - "effective_rank": 6, - "scaled_condition_number": 9.138865693353942, - "weakest_scaled_direction": [ - 0.21590095282642974, - -0.02278911871410716, - 0.05805309090351791, - 0.38233425758098966, - 0.8920217688292351, - -0.08726369627845296 - ] - }, - "forward_reverse": { - "translation_m": 0.007025231148999399, - "rotation_deg": 0.031656114821116355 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.923231402463302e-07, - "rotation_deg": 6.666752573663636e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 32982, - "frame_counter_j": 35181, - "rtk_translation_m": 1.9477165743251885, - "rtk_rotation_deg": 48.70632499880147, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6714357945427303, - 0.7409797572687084, - 0.011089324811676352, - -2.1556763116732927 - ], - [ - -0.7401996490682762, - 0.6713007111638931, - -0.038207783370051526, - 0.0058212063309580255 - ], - [ - -0.035755465679721904, - 0.017445759050780107, - 0.9992082826744229, - -0.05685458682497225 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8844, - "backend_objective": 1532.676220967855, - "backend_elapsed_sec": 0.153170699995826, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4287, - "objective": 885.3657906021791 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6997, - "objective": 767.8888993664846 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8844, - "objective": 1532.676220967855 - } - ], - "heldout_symmetric": { - "evaluated": 8252, - "inliers": 6220, - "inlier_ratio": 0.7537566650508968, - "inlier_rmse_m": 0.1091762180475198, - "median_m": 0.10925792296090209, - "p90_m": 0.6580244250896059, - "p95_m": 1.1486116926170538 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 112246.32775665326, - 183186.7779622805, - 271715.7846072771, - 324412.04697112506, - 612339.9983577128, - 1126172.2546105683 - ], - "effective_rank": 6, - "scaled_condition_number": 10.033043192754391, - "weakest_scaled_direction": [ - -0.23289254451594704, - -0.0550050298744148, - -0.047108061100117095, - -0.07904830339638554, - -0.9640060114975513, - 0.07042808746178442 - ] - }, - "forward_reverse": { - "translation_m": 0.0026262958914527778, - "rotation_deg": 0.05939834892732321 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.899114524108741e-16, - "rotation_deg": 1.20870395905279e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784257345.9129474, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 32982, - "frame_counter_j": 36694, - "rtk_translation_m": 3.76075382790461, - "rtk_rotation_deg": 86.89547500633407, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0644666656346853, - 0.9979197831568541, - 0.0003942158332702403, - -4.387713089983538 - ], - [ - -0.9974379766858642, - 0.06444780546103107, - -0.03104775412275548, - 0.745620028631954 - ], - [ - -0.031008574407019707, - 0.0016083393406249996, - 0.9995178245323142, - -0.04463550107383165 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8138, - "backend_objective": 731.0783593719896, - "backend_elapsed_sec": 0.11442119999992428, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4056, - "objective": 971.6019181356448 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6538, - "objective": 525.7683927356483 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8138, - "objective": 731.0783593719896 - } - ], - "heldout_symmetric": { - "evaluated": 8116, - "inliers": 5769, - "inlier_ratio": 0.7108181370133071, - "inlier_rmse_m": 0.1147630411233105, - "median_m": 0.12535882735652926, - "p90_m": 1.0037060981098196, - "p95_m": 1.6078574464938784 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 80262.93040619565, - 92125.91005238818, - 119809.32007324521, - 199117.06815716045, - 478817.5196452779, - 969400.4609048041 - ], - "effective_rank": 6, - "scaled_condition_number": 12.077810466162274, - "weakest_scaled_direction": [ - 0.1884243501185651, - 0.9109401105554761, - 0.02841744749042532, - -0.24650703763181456, - 0.2691298021603536, - 0.0260817547112759 - ] - }, - "forward_reverse": { - "translation_m": 0.002611195084459223, - "rotation_deg": 0.042823121286843194 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.554447978966673e-16, - "rotation_deg": 1.2250739634268439e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257565.8035393, - "frame_counter_i": 34263, - "frame_counter_j": 35181, - "rtk_translation_m": 0.8778876913955667, - "rtk_rotation_deg": 18.652766664535406, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9501846707839595, - 0.31167381991838555, - 0.0029191410825991247, - -0.23101740505576257 - ], - [ - -0.3116516185249797, - 0.9501757340024526, - -0.006272414500075199, - 0.44249409258633615 - ], - [ - -0.004728644408165246, - 0.005050197063679708, - 0.9999760674294556, - 0.009566449988216407 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 1, - "backend_num_inliers": 10384, - "backend_objective": 621.1794091675052, - "backend_elapsed_sec": 0.0966848999960348, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4458, - "objective": 725.1289300256881 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7713, - "objective": 549.0537686305265 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 1, - "num_inliers": 10384, - "objective": 621.1794091675052 - } - ], - "heldout_symmetric": { - "evaluated": 8323, - "inliers": 7332, - "inlier_ratio": 0.8809323561215908, - "inlier_rmse_m": 0.09065520084082093, - "median_m": 0.06338596860343883, - "p90_m": 0.2816447688623702, - "p95_m": 0.47830609946274666 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 147825.26917328098, - 334749.2248842268, - 472583.81374538614, - 724833.5387890147, - 793723.6241006475, - 1393492.2094908017 - ], - "effective_rank": 6, - "scaled_condition_number": 9.426617095196006, - "weakest_scaled_direction": [ - 0.274421778684222, - 0.018312719053780513, - 0.054784665593092065, - 0.08347777160373543, - 0.9561931834641403, - 0.009057022981420398 - ] - }, - "forward_reverse": { - "translation_m": 0.00074030291113835, - "rotation_deg": 0.005760006892562891 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2661725736537374e-15, - "rotation_deg": 2.4380362340842602e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 34263, - "frame_counter_j": 36694, - "rtk_translation_m": 2.2510479983846268, - "rtk_rotation_deg": 56.84191667206801, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5498304526419244, - 0.8350394638711729, - -0.019888869382678368, - -2.5253556421173213 - ], - [ - -0.8352759534488483, - 0.5496955792808826, - -0.012200479874671634, - -0.008184192277798463 - ], - [ - 0.0007449414030363554, - 0.023320889708575678, - 0.9997277535236808, - -0.08243908734833466 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8642, - "backend_objective": 1205.5852145795657, - "backend_elapsed_sec": 0.0903803000037442, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4282, - "objective": 989.3453103941729 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7088, - "objective": 694.6882592864556 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8642, - "objective": 1205.5852145795657 - } - ], - "heldout_symmetric": { - "evaluated": 8187, - "inliers": 6107, - "inlier_ratio": 0.7459386832783681, - "inlier_rmse_m": 0.1116686389188481, - "median_m": 0.11368671552197367, - "p90_m": 0.6202670010351438, - "p95_m": 1.0211281783165491 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 104797.93383218035, - 130672.314209947, - 171215.12308315383, - 348512.3549672162, - 524057.65994595987, - 1097441.9402860645 - ], - "effective_rank": 6, - "scaled_condition_number": 10.471980698049531, - "weakest_scaled_direction": [ - 0.08734497402272949, - 0.8945389310767448, - 0.020030967527083266, - -0.2546147351604989, - 0.24297976691160295, - 0.2605799035837275 - ] - }, - "forward_reverse": { - "translation_m": 0.010212372381123916, - "rotation_deg": 0.01461127103474581 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.460869650712945e-07, - "rotation_deg": 9.182224664436201e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784257474.0083263, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 34263, - "frame_counter_j": 38208, - "rtk_translation_m": 3.452614527841686, - "rtk_rotation_deg": 105.36038662410485, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.26117079822178163, - 0.9644343039652238, - -0.04069751210223269, - -4.6707681257531855 - ], - [ - -0.9644707747665123, - -0.26245579177472883, - -0.030217246485806138, - 0.26233757916000633 - ], - [ - -0.03982384684433713, - 0.03135969864354756, - 0.9987144889924768, - -0.1425668815602738 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7152, - "backend_objective": 394.64638505038437, - "backend_elapsed_sec": 0.10322180000366643, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3440, - "objective": 1396.9611376120156 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5617, - "objective": 482.5116489746272 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7152, - "objective": 394.64638505038437 - } - ], - "heldout_symmetric": { - "evaluated": 8396, - "inliers": 5248, - "inlier_ratio": 0.6250595521676989, - "inlier_rmse_m": 0.10935727133461083, - "median_m": 0.141386713300931, - "p90_m": 1.312745325058518, - "p95_m": 2.0069524080406715 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 17621.425385159735, - 74642.71940526017, - 107457.87118789129, - 196501.5954954894, - 422952.2985742606, - 837279.40926976 - ], - "effective_rank": 6, - "scaled_condition_number": 47.514851436189325, - "weakest_scaled_direction": [ - 0.6405157926099917, - 0.05603061402867604, - 0.012705937876039266, - 0.040221017474426496, - 0.04770492109853462, - -0.7632464602654625 - ] - }, - "forward_reverse": { - "translation_m": 0.013489723519689117, - "rotation_deg": 0.0723917800582207 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7554167342883505e-15, - "rotation_deg": 1.058941004767027e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257717.098528, - "frame_counter_i": 35181, - "frame_counter_j": 36694, - "rtk_translation_m": 1.8212773036309853, - "rtk_rotation_deg": 38.18915000753262, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7828420861834561, - 0.6222023223877882, - -0.004747432482641514, - -2.052040400916114 - ], - [ - -0.622203812562064, - 0.7828541563974981, - 0.0013362052212054889, - -1.1472757246153065 - ], - [ - 0.004547937243073154, - 0.001907832907642801, - 0.9999878381462592, - 0.0021736938537358693 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 27, - "backend_num_inliers": 9182, - "backend_objective": 1459.2689878513988, - "backend_elapsed_sec": 0.1935003000035067, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4343, - "objective": 766.3599039487772 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7314, - "objective": 535.3778343060385 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 27, - "num_inliers": 9182, - "objective": 1459.2689878513988 - } - ], - "heldout_symmetric": { - "evaluated": 8174, - "inliers": 6487, - "inlier_ratio": 0.7936138977244923, - "inlier_rmse_m": 0.11107653584131949, - "median_m": 0.10552278410071086, - "p90_m": 0.5399375316960431, - "p95_m": 0.8137959921738659 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 115215.10272737782, - 138413.21023887434, - 164076.07876399724, - 409666.1119181982, - 542164.707077967, - 1228267.1349095139 - ], - "effective_rank": 6, - "scaled_condition_number": 10.660643490600723, - "weakest_scaled_direction": [ - 0.37104591305470935, - 0.3029344758671207, - 0.04375931269114202, - -0.4596495292626477, - 0.7198644741227814, - -0.1978843233656125 - ] - }, - "forward_reverse": { - "translation_m": 0.008437497431588122, - "rotation_deg": 0.2765568737620497 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1696153541059582e-15, - "rotation_deg": 3.466829082744138e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 35181, - "frame_counter_j": 38208, - "rtk_translation_m": 2.999856552735995, - "rtk_rotation_deg": 86.70761995956946, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.05238189124450325, - 0.9980158708063465, - -0.03493506960490722, - -4.1608777944134605 - ], - [ - -0.9982466013425184, - 0.051364226143093564, - -0.029418347690390517, - -1.5596916289818672 - ], - [ - -0.027565565072397765, - 0.03641480319007395, - 0.9989565064260142, - -0.1504081932683384 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7154, - "backend_objective": 459.00486311859095, - "backend_elapsed_sec": 0.0938326000032248, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3518, - "objective": 854.3463362217843 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5736, - "objective": 513.9064245992633 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7154, - "objective": 459.00486311859095 - } - ], - "heldout_symmetric": { - "evaluated": 8383, - "inliers": 5313, - "inlier_ratio": 0.6337826553739712, - "inlier_rmse_m": 0.11196536842375276, - "median_m": 0.14230248881135135, - "p90_m": 1.2326130401015785, - "p95_m": 1.7908849095603119 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 19623.56722822964, - 57322.12035283127, - 110373.0462236796, - 174464.95917561726, - 437026.18373390555, - 860456.1971933377 - ], - "effective_rank": 6, - "scaled_condition_number": 43.84810300726168, - "weakest_scaled_direction": [ - 0.6015300015349042, - 0.2456096815982743, - 0.016199358483158666, - 0.009074648563929734, - 0.048722022347786435, - -0.7583659655042078 - ] - }, - "forward_reverse": { - "translation_m": 0.02359951283541323, - "rotation_deg": 0.10308564406068685 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8126324738138794e-15, - "rotation_deg": 4.8135281366282376e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784257565.8035393, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 35181, - "frame_counter_j": 39321, - "rtk_translation_m": 1.7088514993141615, - "rtk_rotation_deg": 157.34900000166795, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9199398255604516, - 0.38587479487631715, - -0.0693639677856347, - -3.9700983175132265 - ], - [ - -0.3844941460689145, - -0.9225445027998098, - -0.03280079256034214, - 0.288658541566172 - ], - [ - -0.07664834627402314, - -0.0035047158245163717, - 0.997052028722898, - -0.10418992583362652 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6986, - "backend_objective": 317.1229617798327, - "backend_elapsed_sec": 0.1138104999990901, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 3757, - "objective": 928.9809518686691 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5714, - "objective": 406.6866820919339 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6986, - "objective": 317.1229617798327 - } - ], - "heldout_symmetric": { - "evaluated": 8350, - "inliers": 5071, - "inlier_ratio": 0.6073053892215569, - "inlier_rmse_m": 0.11004156310392302, - "median_m": 0.1503811965872069, - "p90_m": 1.4545155707492854, - "p95_m": 2.161460630169156 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18282.55642566601, - 43632.21289998136, - 73817.67347357208, - 100296.36258563763, - 527079.5467069771, - 963672.2684600573 - ], - "effective_rank": 6, - "scaled_condition_number": 52.70992994760862, - "weakest_scaled_direction": [ - 0.1455020046670619, - 0.6885094824322612, - 0.015251441083490011, - -0.01478691751295014, - 0.04203270624771282, - -0.7089187904545636 - ] - }, - "forward_reverse": { - "translation_m": 0.013062761031411258, - "rotation_deg": 0.0548185753269731 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.8769455291112424e-08, - "rotation_deg": 3.829153020710623e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784257868.4921277, - "frame_counter_i": 36694, - "frame_counter_j": 38208, - "rtk_translation_m": 1.2059352225587747, - "rtk_rotation_deg": 48.51846995203683, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.661932640310347, - 0.7494664954974063, - 0.012047896854143076, - -1.4126063790512007 - ], - [ - -0.7491747219592472, - 0.6620215026453391, - -0.02155843251473483, - -1.641376947033325 - ], - [ - -0.02413328964433151, - 0.0052442503795345355, - 0.9996949945702934, - -0.07708577381737622 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8856, - "backend_objective": 1067.4330793025547, - "backend_elapsed_sec": 0.08917420000216225, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3762, - "objective": 918.5596487434932 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6644, - "objective": 608.2382079992943 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8856, - "objective": 1067.4330793025547 - } - ], - "heldout_symmetric": { - "evaluated": 8247, - "inliers": 6514, - "inlier_ratio": 0.7898629804777495, - "inlier_rmse_m": 0.11080878069613129, - "median_m": 0.10515198945495972, - "p90_m": 0.55617380599531, - "p95_m": 0.9873816729236244 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53234.70175399212, - 133189.45361648567, - 178869.53021730707, - 461289.18132088607, - 576676.001074041, - 922187.5526725405 - ], - "effective_rank": 6, - "scaled_condition_number": 17.323052863790767, - "weakest_scaled_direction": [ - -0.6471430287995081, - -0.04207749158912655, - -0.01288404768254579, - -0.03678499498878226, - -0.05910951048276367, - 0.7579065352714954 - ] - }, - "forward_reverse": { - "translation_m": 0.024355899665769485, - "rotation_deg": 0.10833606018329535 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.443059973708341e-16, - "rotation_deg": 1.3835484549488275e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 36694, - "frame_counter_j": 39321, - "rtk_translation_m": 1.1958827550030364, - "rtk_rotation_deg": 119.15984999413537, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4816482382055926, - 0.8760982096347596, - -0.0216079084646757, - -2.4058592706151924 - ], - [ - -0.8750691374259397, - -0.48213018937554886, - -0.04247923277695767, - -0.08085078385738464 - ], - [ - -0.04763380478263441, - -0.0015516338055845244, - 0.9988636609039611, - -0.036863304059313456 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8543, - "backend_objective": 637.4093888411896, - "backend_elapsed_sec": 0.10902630000055069, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 19, - "num_inliers": 3940, - "objective": 839.5238974819919 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6585, - "objective": 547.4807964080929 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8543, - "objective": 637.4093888411896 - } - ], - "heldout_symmetric": { - "evaluated": 8214, - "inliers": 6173, - "inlier_ratio": 0.7515217920623326, - "inlier_rmse_m": 0.10216449744519186, - "median_m": 0.09678361472736571, - "p90_m": 0.817319060290232, - "p95_m": 1.7202390341887257 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 37579.67669235824, - 98857.36224532576, - 137113.9587209269, - 292951.44246497896, - 619384.3299549641, - 1032625.3746948714 - ], - "effective_rank": 6, - "scaled_condition_number": 27.478293204817643, - "weakest_scaled_direction": [ - -0.166504606586953, - -0.6169557762935312, - -0.008762142737447924, - 0.02360423431332221, - -0.0242956713074731, - 0.7683863425492548 - ] - }, - "forward_reverse": { - "translation_m": 0.010967953426658109, - "rotation_deg": 0.044641472084512177 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.520587824777509e-07, - "rotation_deg": 1.0910129472074577e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784257717.098528, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 36694, - "frame_counter_j": 42886, - "rtk_translation_m": 3.786115539231191, - "rtk_rotation_deg": 149.59794999698258, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.862006156704005, - 0.5066053181156143, - -0.017217359302974362, - -1.504654604116278 - ], - [ - -0.506233451703228, - -0.8621180833824024, - -0.02191124555311741, - 3.005044896034999 - ], - [ - -0.02594375032693281, - -0.01017162533868107, - 0.9996116545223662, - 0.02786781214175368 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7408, - "backend_objective": 871.7795450355737, - "backend_elapsed_sec": 0.12838569999439642, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3431, - "objective": 758.0609947855522 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5973, - "objective": 530.8530398322829 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7408, - "objective": 871.7795450355737 - } - ], - "heldout_symmetric": { - "evaluated": 8082, - "inliers": 5059, - "inlier_ratio": 0.6259589210591437, - "inlier_rmse_m": 0.11074683701330018, - "median_m": 0.14734785369889053, - "p90_m": 3.1176998297775786, - "p95_m": 3.7203703882130057 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42011.52443722787, - 66379.23256208161, - 120664.90215124008, - 207321.4520374959, - 581782.4711932878, - 1096745.6237588106 - ], - "effective_rank": 6, - "scaled_condition_number": 26.105827828207687, - "weakest_scaled_direction": [ - 0.11986500018100398, - 0.047870631068931385, - 0.00926000257058556, - -0.06920799351519549, - 0.9891730489302452, - 0.0014034488614361922 - ] - }, - "forward_reverse": { - "translation_m": 0.04374270593226806, - "rotation_deg": 0.34168251600562055 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.1967783855013905e-11, - "rotation_deg": 1.1596169430270299e-10 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784257979.7876303, - "frame_counter_i": 38208, - "frame_counter_j": 39321, - "rtk_translation_m": 1.8270495459501794, - "rtk_rotation_deg": 70.64138004209858, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3381459661088486, - 0.9410815346962366, - -0.0047802361959529355, - -1.825249084463979 - ], - [ - -0.9403313731939333, - 0.3376632987551519, - -0.041957183663837314, - 0.29019533530798414 - ], - [ - -0.03787102047114166, - 0.018682658471546428, - 0.9991079741854281, - -0.05261495108796456 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8930, - "backend_objective": 1314.5821611353656, - "backend_elapsed_sec": 0.11832290000165813, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4218, - "objective": 769.2598889574915 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7142, - "objective": 621.7096910604276 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8930, - "objective": 1314.5821611353656 - } - ], - "heldout_symmetric": { - "evaluated": 8423, - "inliers": 6969, - "inlier_ratio": 0.8273774189718628, - "inlier_rmse_m": 0.10613402567174812, - "median_m": 0.09161192876949621, - "p90_m": 0.409448906433105, - "p95_m": 0.6774855270154584 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53549.492569895774, - 118513.03155342248, - 246751.66041994575, - 432150.6567597645, - 649554.9140287593, - 935985.0251132662 - ], - "effective_rank": 6, - "scaled_condition_number": 17.478877580241615, - "weakest_scaled_direction": [ - 0.31509086601162567, - 0.6041095973121455, - 0.024628848685139322, - -0.016786962942645076, - 0.044484113197288504, - -0.7300014533903744 - ] - }, - "forward_reverse": { - "translation_m": 0.018863132797671257, - "rotation_deg": 0.12251687299132978 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.03594618170779e-16, - "rotation_deg": 1.619820757743732e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 38208, - "frame_counter_j": 42886, - "rtk_translation_m": 4.741885618180033, - "rtk_rotation_deg": 101.07948004494568, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.19074511565657937, - 0.9814933565646136, - -0.016943785665734696, - -3.5479980337753476 - ], - [ - -0.9815446266261133, - -0.19093834294039785, - -0.010615796558873654, - 2.9995967901532823 - ], - [ - -0.013654552155328622, - 0.014606170432497382, - 0.9998000865126656, - -0.04865826265971966 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 6764, - "backend_objective": 799.7339656762351, - "backend_elapsed_sec": 0.12969690000318224, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3489, - "objective": 1142.7104495883302 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5664, - "objective": 613.0560295001194 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 6764, - "objective": 799.7339656762351 - } - ], - "heldout_symmetric": { - "evaluated": 8291, - "inliers": 5171, - "inlier_ratio": 0.6236883367506936, - "inlier_rmse_m": 0.11275084173352168, - "median_m": 0.14684847408458745, - "p90_m": 3.070232795704604, - "p95_m": 3.6748877051579476 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32865.20923501317, - 48216.25428961527, - 78287.7599400756, - 270689.02302851796, - 667717.3633039412, - 876025.3802631269 - ], - "effective_rank": 6, - "scaled_condition_number": 26.65509822252546, - "weakest_scaled_direction": [ - 0.2277630857740826, - -0.6873217408781405, - 0.006782507597647006, - 0.040541369599813325, - 0.14623002158264448, - 0.672785238396703 - ] - }, - "forward_reverse": { - "translation_m": 0.005757137825848521, - "rotation_deg": 0.2558617834036415 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.974071781012647e-16, - "rotation_deg": 3.628999858218488e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784257868.4921277, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 38208, - "frame_counter_j": 43788, - "rtk_translation_m": 3.8640843382258447, - "rtk_rotation_deg": 141.59343004213218, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7834500070548733, - 0.6207956613225486, - -0.028615263913132506, - -5.472161895617002 - ], - [ - -0.6199982224383886, - -0.7839354376697685, - -0.03236408099649281, - 1.3488057029270297 - ], - [ - -0.04252400050509174, - -0.007614226724279282, - 0.999066430690389, - -0.13547947317854486 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6126, - "backend_objective": 450.15620542568206, - "backend_elapsed_sec": 0.1692821999968146, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 3390, - "objective": 751.5591907645196 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5297, - "objective": 493.14490134957566 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6126, - "objective": 450.15620542568206 - } - ], - "heldout_symmetric": { - "evaluated": 8432, - "inliers": 4951, - "inlier_ratio": 0.5871679316888045, - "inlier_rmse_m": 0.11732003715351383, - "median_m": 0.1714726622142625, - "p90_m": 2.3262656558828922, - "p95_m": 3.188722019325457 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18473.764208540917, - 40114.34302178439, - 53863.672361338, - 141074.67465766257, - 698094.031955814, - 963547.7416417592 - ], - "effective_rank": 6, - "scaled_condition_number": 52.15762909847497, - "weakest_scaled_direction": [ - 0.610387920152442, - -0.3734240650435089, - 0.022335896822000607, - 0.015803526646712012, - 0.027523941459897092, - 0.6974774860047832 - ] - }, - "forward_reverse": { - "translation_m": 1.0486443236448235, - "rotation_deg": 4.536374847153588 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8530437519459085e-15, - "rotation_deg": 1.1706421024815753e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258336.2740397, - "frame_counter_i": 39321, - "frame_counter_j": 42886, - "rtk_translation_m": 2.939444415707082, - "rtk_rotation_deg": 30.43810000284707, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8594047440203669, - 0.5109063528464833, - -0.0199545627963334, - -3.1418375289888725 - ], - [ - -0.5111135185175572, - 0.8594859831051122, - -0.006842224378301732, - -0.7053628061233146 - ], - [ - 0.013654931119963866, - 0.016079286891677806, - 0.9997774749358799, - -0.11259514578021326 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7275, - "backend_objective": 800.6912230790897, - "backend_elapsed_sec": 0.09443759999703616, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3558, - "objective": 971.2917859251526 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5812, - "objective": 603.0226982327248 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7275, - "objective": 800.6912230790897 - } - ], - "heldout_symmetric": { - "evaluated": 8258, - "inliers": 5438, - "inlier_ratio": 0.6585129571324776, - "inlier_rmse_m": 0.10848902314415616, - "median_m": 0.13077153868357388, - "p90_m": 1.7246589857788317, - "p95_m": 2.8052586266701134 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 37420.3270067059, - 40691.45681632048, - 124820.13417958445, - 283637.82573285024, - 719915.5602281264, - 1131128.1544099585 - ], - "effective_rank": 6, - "scaled_condition_number": 30.227639491425478, - "weakest_scaled_direction": [ - -0.18508654993639492, - 0.6744689894207156, - 0.0008841784253442042, - -0.03878687765331216, - -0.22402492046871555, - -0.6776003119109717 - ] - }, - "forward_reverse": { - "translation_m": 0.002959097196576797, - "rotation_deg": 0.043581628031778105 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0003742004269058e-14, - "rotation_deg": 1.0233482909075381e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 39321, - "frame_counter_j": 43788, - "rtk_translation_m": 2.285770454773634, - "rtk_rotation_deg": 70.95205000003368, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3192600747314929, - 0.9476538080517757, - 0.005026407008022054, - -2.238747275079242 - ], - [ - -0.9472252749848606, - 0.3192686770033026, - -0.02884077520483351, - -3.061520652327222 - ], - [ - -0.028935844765557033, - 0.004446568286849817, - 0.9995713806017927, - -0.04232395687673986 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6933, - "backend_objective": 577.925568117466, - "backend_elapsed_sec": 0.11266429999523098, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3618, - "objective": 883.726497418723 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5784, - "objective": 661.0787086477357 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6933, - "objective": 577.925568117466 - } - ], - "heldout_symmetric": { - "evaluated": 8399, - "inliers": 5584, - "inlier_ratio": 0.6648410525062507, - "inlier_rmse_m": 0.11120026543063653, - "median_m": 0.13196842355274793, - "p90_m": 1.6201776909615178, - "p95_m": 2.3588043255788214 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26184.361240521695, - 46459.75349652479, - 126422.5614461839, - 161710.68414748504, - 724618.992923463, - 1193113.935631357 - ], - "effective_rank": 6, - "scaled_condition_number": 45.565898082132684, - "weakest_scaled_direction": [ - 0.5732864163247975, - -0.38073625141531375, - 0.01777603021370582, - 0.06747890508192833, - -0.0376473224502211, - 0.7211767335035149 - ] - }, - "forward_reverse": { - "translation_m": 0.012512803173543077, - "rotation_deg": 0.11122589391716618 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.1414802831273163e-15, - "rotation_deg": 1.798617310358576e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784257979.7876303, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 39321, - "frame_counter_j": 45217, - "rtk_translation_m": 3.6568094249627374, - "rtk_rotation_deg": 131.92299999999997, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6705393900450899, - 0.7416325827277485, - -0.01892190885001077, - -3.0279072101540447 - ], - [ - -0.7410096157467239, - -0.670771116924119, - -0.031158595463576008, - -4.529074091459608 - ], - [ - -0.03580049956147909, - -0.006871749190666957, - 0.9993353307545016, - -0.10193391930434982 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6052, - "backend_objective": 385.9354719230669, - "backend_elapsed_sec": 0.10751409999647876, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3358, - "objective": 1042.4194430299667 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5002, - "objective": 565.972300440508 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6052, - "objective": 385.9354719230669 - } - ], - "heldout_symmetric": { - "evaluated": 8403, - "inliers": 4954, - "inlier_ratio": 0.5895513507080804, - "inlier_rmse_m": 0.11693751976202812, - "median_m": 0.1699906365140463, - "p90_m": 1.7643713593889288, - "p95_m": 2.517581104742794 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15780.535634190963, - 38345.93456549966, - 50535.82140822712, - 137355.2462083888, - 676813.0439592459, - 980602.8609458691 - ], - "effective_rank": 6, - "scaled_condition_number": 62.1400238672027, - "weakest_scaled_direction": [ - 0.6512013671854775, - 0.30388478095673654, - 0.01954795313695127, - 0.020128792939304373, - 0.039871543863837317, - 0.6936957463409427 - ] - }, - "forward_reverse": { - "translation_m": 2.7672344834891307, - "rotation_deg": 9.168367379205225 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 0.14755053457882952, - "rotation_deg": 1.1483257623949923 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258426.469848, - "frame_counter_i": 42886, - "frame_counter_j": 43788, - "rtk_translation_m": 2.3764785758716087, - "rtk_rotation_deg": 40.513949997186636, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7581877550394371, - 0.6511507045366458, - 0.03397187203686505, - 1.9806681012525742 - ], - [ - -0.6513448966309727, - 0.758753824791532, - -0.006516056860479788, - -1.5706692252961945 - ], - [ - -0.03001922285880208, - -0.017187010957456002, - 0.9994015473838842, - 0.032870798122648155 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8368, - "backend_objective": 782.622857206924, - "backend_elapsed_sec": 0.0803581000000122, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3786, - "objective": 749.0555673537326 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6513, - "objective": 863.606444220591 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8368, - "objective": 782.622857206924 - } - ], - "heldout_symmetric": { - "evaluated": 8267, - "inliers": 6576, - "inlier_ratio": 0.7954517962985364, - "inlier_rmse_m": 0.10154002419986238, - "median_m": 0.0904443734886855, - "p90_m": 0.5323776481825999, - "p95_m": 1.0273357005120614 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47332.138326291766, - 109754.97025509289, - 209943.88185445842, - 279260.5623110351, - 772472.0078590306, - 1231353.6778129893 - ], - "effective_rank": 6, - "scaled_condition_number": 26.01517111533084, - "weakest_scaled_direction": [ - -0.5448315811128842, - 0.4320513821061679, - -0.005052498225729096, - -0.02550295248556129, - -0.0133218253900731, - -0.7180785138734201 - ] - }, - "forward_reverse": { - "translation_m": 0.019135551099374308, - "rotation_deg": 0.08227568287606397 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1727346559588511e-15, - "rotation_deg": 7.160618248248787e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 42886, - "frame_counter_j": 45217, - "rtk_translation_m": 4.061689152213973, - "rtk_rotation_deg": 101.48489999715295, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1982496037289595, - 0.9799227851409482, - 0.021176160721829995, - 2.0476172761992126 - ], - [ - -0.9799758757730468, - -0.19775874986956668, - -0.02321119886769715, - -3.2424188673143512 - ], - [ - -0.018557411569508107, - -0.025353737626481167, - 0.9995062833540406, - -0.10149049807438078 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7535, - "backend_objective": 753.0922680214431, - "backend_elapsed_sec": 0.12084090000280412, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3601, - "objective": 832.3803569605518 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5855, - "objective": 607.105584834318 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7535, - "objective": 753.0922680214431 - } - ], - "heldout_symmetric": { - "evaluated": 8271, - "inliers": 6159, - "inlier_ratio": 0.7446499818643453, - "inlier_rmse_m": 0.1104935519181424, - "median_m": 0.11102412380722071, - "p90_m": 0.7365579662458553, - "p95_m": 1.2858176040931273 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33736.28567934059, - 80361.48150361789, - 152911.54929017345, - 238910.5625137653, - 716820.3925508568, - 1103112.2440316644 - ], - "effective_rank": 6, - "scaled_condition_number": 32.698094109014136, - "weakest_scaled_direction": [ - 0.663289358634731, - 0.26686719551236326, - 0.011449287640708511, - 0.029239254984095693, - 0.04501351334477739, - 0.6970056600043839 - ] - }, - "forward_reverse": { - "translation_m": 0.015390416284740782, - "rotation_deg": 0.08645102756020058 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6300346472626374e-15, - "rotation_deg": 1.2447809708333758e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784258336.2740397, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 42886, - "frame_counter_j": 46130, - "rtk_translation_m": 5.033742765789926, - "rtk_rotation_deg": 178.61309998505533, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9991637267813427, - 0.019803988653202275, - 0.035772183576664965, - -7.564499863112411 - ], - [ - -0.020377811157580906, - -0.9996683134835215, - -0.01574826433097505, - 0.5025665859325109 - ], - [ - 0.0354484399775893, - -0.016464053280894318, - 0.9992358795863558, - 0.20859683301637966 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 5619, - "backend_objective": 211.78388304807277, - "backend_elapsed_sec": 0.1046169999972335, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 2361, - "objective": 859.7060087319638 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4008, - "objective": 281.3067862680225 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 5619, - "objective": 211.78388304807277 - } - ], - "heldout_symmetric": { - "evaluated": 8283, - "inliers": 4832, - "inlier_ratio": 0.583363515634432, - "inlier_rmse_m": 0.11446907648011068, - "median_m": 0.16670128502920012, - "p90_m": 2.8854415993968523, - "p95_m": 5.3452346082978 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6200.046946996951, - 22062.53857581153, - 47308.849705995104, - 50512.24687549569, - 207592.82638899345, - 655085.4194479366 - ], - "effective_rank": 6, - "scaled_condition_number": 105.65813856703667, - "weakest_scaled_direction": [ - 0.9724389089081938, - -0.22655484173325904, - -0.04046252774044135, - 0.01365699245843499, - 0.006169463663999609, - -0.03425901709918313 - ] - }, - "forward_reverse": { - "translation_m": 0.017491035693048888, - "rotation_deg": 0.22327775856236398 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 3.2357618629532405, - "rotation_deg": 16.095233433493107 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "multistart_instability" - ] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258569.364867, - "frame_counter_i": 43788, - "frame_counter_j": 45217, - "rtk_translation_m": 1.7860052935263149, - "rtk_rotation_deg": 60.970949999966315, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.48906759141608885, - 0.8722359677105127, - -0.00416024741708328, - 1.1468893759538556 - ], - [ - -0.8719161235637879, - 0.4887459906905548, - -0.02982666681688444, - -1.221605553804855 - ], - [ - -0.02398258734922404, - 0.018214642901073358, - 0.9995464282803592, - -0.028424834069849664 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8753, - "backend_objective": 1003.1060265719825, - "backend_elapsed_sec": 0.07757270000001881, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4025, - "objective": 799.9289876509342 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6694, - "objective": 645.4481402338722 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8753, - "objective": 1003.1060265719825 - } - ], - "heldout_symmetric": { - "evaluated": 8412, - "inliers": 6997, - "inlier_ratio": 0.8317879220161674, - "inlier_rmse_m": 0.10401467258245657, - "median_m": 0.09245189556038982, - "p90_m": 0.42262525048492794, - "p95_m": 0.7076491492000743 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 79408.41520552456, - 162968.5244327397, - 257945.08258293514, - 497580.16019275883, - 996019.8816107758, - 1338551.102406112 - ], - "effective_rank": 6, - "scaled_condition_number": 16.856539687156317, - "weakest_scaled_direction": [ - -0.7182334022485661, - -0.2695794418685713, - -0.022116872962756967, - -0.012117836557601793, - -0.061102893370830316, - -0.638042430254842 - ] - }, - "forward_reverse": { - "translation_m": 0.007126704551442278, - "rotation_deg": 0.059447117802805614 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.22450001747642e-15, - "rotation_deg": 1.6134907396145982e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 43788, - "frame_counter_j": 46130, - "rtk_translation_m": 7.378510482049102, - "rtk_rotation_deg": 138.09914998778677, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7451400803509487, - 0.6668305176734942, - 0.01016471120499707, - -8.594359352584359 - ], - [ - -0.6668371323096429, - -0.7451965367564827, - 0.0032187853602832052, - -4.660901644650214 - ], - [ - 0.009721091895171136, - -0.0043797608887020485, - 0.9999431574179234, - -0.02947390993590963 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 4879, - "backend_objective": 185.4818259492826, - "backend_elapsed_sec": 0.13718820000212872, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 2367, - "objective": 710.8952631659891 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 3720, - "objective": 281.5325018758702 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 4879, - "objective": 185.4818259492826 - } - ], - "heldout_symmetric": { - "evaluated": 8424, - "inliers": 4552, - "inlier_ratio": 0.540360873694207, - "inlier_rmse_m": 0.1217315596532435, - "median_m": 0.2028736283859898, - "p90_m": 2.3552265210766943, - "p95_m": 4.368691806433767 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2337.931520190746, - 5405.130051670216, - 30100.516357509314, - 45029.66055405246, - 220473.5327204934, - 568191.8567659601 - ], - "effective_rank": 6, - "scaled_condition_number": 243.03186464572013, - "weakest_scaled_direction": [ - 0.9643072935600814, - -0.2097460670446838, - -0.03894297848872667, - 0.008910008030762126, - 0.017119903778430076, - -0.15565666071213852 - ] - }, - "forward_reverse": { - "translation_m": 0.02476143939627759, - "rotation_deg": 0.2783665026489561 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0504962878060688e-14, - "rotation_deg": 9.403199220852668e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784258426.469848, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 43788, - "frame_counter_j": 47324, - "rtk_translation_m": 8.396001985859645, - "rtk_rotation_deg": 161.15751666826222, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.944961099139658, - 0.3270842222047632, - 0.008026998036277846, - -9.756052166063991 - ], - [ - -0.32702554676057116, - -0.9449832310782069, - 0.007809273137867872, - -4.782264381515039 - ], - [ - 0.010139668570464347, - 0.004754425906181655, - 0.9999372893114769, - 0.01724223742323249 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 4584, - "backend_objective": 197.02064937395338, - "backend_elapsed_sec": 0.10418490000301972, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 2411, - "objective": 764.2543963045339 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 3563, - "objective": 278.88343747101464 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 4584, - "objective": 197.02064937395338 - } - ], - "heldout_symmetric": { - "evaluated": 8303, - "inliers": 4194, - "inlier_ratio": 0.5051186318198242, - "inlier_rmse_m": 0.12667907013046822, - "median_m": 0.24292099525086236, - "p90_m": 2.6680163682238924, - "p95_m": 4.9727585025473005 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3986.564215328126, - 10112.502641509458, - 35949.821910829785, - 53263.761427487305, - 192836.19895239343, - 578557.2003850118 - ], - "effective_rank": 6, - "scaled_condition_number": 145.12677311467613, - "weakest_scaled_direction": [ - 0.5232200700286965, - 0.4591240603300073, - -0.04003143552206389, - -0.03589347742603941, - -0.03297244873544573, - -0.7151697809736867 - ] - }, - "forward_reverse": { - "translation_m": 0.01381623315543165, - "rotation_deg": 0.08866229443960012 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.849754368923178e-15, - "rotation_deg": 3.246304405230179e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258660.65995, - "frame_counter_i": 45217, - "frame_counter_j": 46130, - "rtk_translation_m": 8.925911734961222, - "rtk_rotation_deg": 77.12819998782052, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.21807991113059863, - 0.9759278887465903, - 0.0024307052255580666, - -1.774386062994479 - ], - [ - -0.9758070247888536, - 0.2180118654771397, - 0.016476555583702816, - -10.168274079601641 - ], - [ - 0.015550007523969973, - -0.005965105011722816, - 0.9998612977749479, - -0.01446004754829918 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 4886, - "backend_objective": 276.0249112694463, - "backend_elapsed_sec": 0.0943461999995634, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 2493, - "objective": 652.6795647218955 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 3854, - "objective": 421.9664236054255 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 4886, - "objective": 276.0249112694463 - } - ], - "heldout_symmetric": { - "evaluated": 8428, - "inliers": 4402, - "inlier_ratio": 0.5223065970574277, - "inlier_rmse_m": 0.12780035193537048, - "median_m": 0.22296005954916004, - "p90_m": 2.188049196705964, - "p95_m": 4.08498443716224 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5782.312930505993, - 35505.83474647461, - 45086.480869993116, - 80677.30231858409, - 272993.21046600724, - 548675.9505507131 - ], - "effective_rank": 6, - "scaled_condition_number": 94.88866430179526, - "weakest_scaled_direction": [ - 0.3524692892481184, - 0.5146985438155333, - -0.03131503499282641, - -0.07104067480964905, - 0.030173592122546337, - -0.7771183658719598 - ] - }, - "forward_reverse": { - "translation_m": 0.06232017355575957, - "rotation_deg": 1.955625956099923 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2803286093439427e-15, - "rotation_deg": 2.320557612535338e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 45217, - "frame_counter_j": 47324, - "rtk_translation_m": 9.936139535050964, - "rtk_rotation_deg": 100.18656666829587, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.17664741642748774, - 0.9839208774122287, - -0.026370386076884734, - -2.232798466192303 - ], - [ - -0.9841796585942951, - -0.17619572869613123, - 0.0185866833635216, - -11.249037923220381 - ], - [ - 0.01364147641240443, - 0.029236487162270054, - 0.9994794334750967, - 0.05133437603173064 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 4483, - "backend_objective": 222.0994430444109, - "backend_elapsed_sec": 0.10948400000052061, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 2515, - "objective": 696.1177442166507 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 3725, - "objective": 329.80503609678 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 4483, - "objective": 222.0994430444109 - } - ], - "heldout_symmetric": { - "evaluated": 8307, - "inliers": 4107, - "inlier_ratio": 0.49440231130371975, - "inlier_rmse_m": 0.12866710903574613, - "median_m": 0.2582119201812203, - "p90_m": 2.4056612758268483, - "p95_m": 4.507961352882291 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4153.957693840661, - 32785.60922372744, - 37257.83211331094, - 84011.22192009904, - 255844.65552379464, - 542086.7316076679 - ], - "effective_rank": 6, - "scaled_condition_number": 130.4988571288183, - "weakest_scaled_direction": [ - 0.11016172674924486, - 0.5808821953589809, - -0.04000673576438782, - -0.07528466453172718, - -0.0033986766687543464, - -0.8019728165288899 - ] - }, - "forward_reverse": { - "translation_m": 0.047123741889749056, - "rotation_deg": 0.2295904679982487 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.245025178224007e-09, - "rotation_deg": 4.8082578372661155e-09 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784258569.364867, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 45217, - "frame_counter_j": 48071, - "rtk_translation_m": 9.719184595429152, - "rtk_rotation_deg": 159.1482027457047, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9504616315217699, - 0.3064317159863794, - -0.052175573237107864, - -3.0861725732457788 - ], - [ - -0.30763948704939603, - -0.951355522642591, - 0.016751583370807302, - -10.151106459574333 - ], - [ - -0.044504303308360124, - 0.03197300384836252, - 0.9984974181298365, - -0.07405067016772916 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 4648, - "backend_objective": 298.82558492509673, - "backend_elapsed_sec": 0.18313539999508066, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 2496, - "objective": 872.3070058044425 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 3851, - "objective": 327.96007455598055 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 4648, - "objective": 298.82558492509673 - } - ], - "heldout_symmetric": { - "evaluated": 8339, - "inliers": 4153, - "inlier_ratio": 0.49802134548507015, - "inlier_rmse_m": 0.12675987702934546, - "median_m": 0.2534444774142521, - "p90_m": 2.3020903914136692, - "p95_m": 4.149463436133379 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 13453.721562114615, - 25503.500871733588, - 30228.383469755307, - 65173.052809451714, - 296710.5549179535, - 667923.8202554415 - ], - "effective_rank": 6, - "scaled_condition_number": 49.64602672737782, - "weakest_scaled_direction": [ - 0.11245091314655653, - 0.45135229929460857, - -0.024933193619182472, - -0.06584735923888355, - -0.04170460326307528, - -0.881441479202028 - ] - }, - "forward_reverse": { - "translation_m": 0.0323736334045635, - "rotation_deg": 0.06974950067660468 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 4.924904526649195, - "rotation_deg": 0.6921966652080033 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "multistart_instability" - ] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258780.056085, - "frame_counter_i": 46130, - "frame_counter_j": 47324, - "rtk_translation_m": 1.0176267260390144, - "rtk_rotation_deg": 23.058366680475352, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9225968970866422, - 0.3857348283702317, - -0.004858772302461086, - 0.9454444486243054 - ], - [ - -0.3857351051906694, - 0.9226091189697154, - 0.0009177240700653349, - -0.6801219614881889 - ], - [ - 0.004836745769905961, - 0.00102750966576333, - 0.9999877749823963, - -0.05303267515253478 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8825, - "backend_objective": 1061.5989185039393, - "backend_elapsed_sec": 0.12816720000409987, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3513, - "objective": 636.6474859771212 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 6306, - "objective": 708.7497897639247 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8825, - "objective": 1061.5989185039393 - } - ], - "heldout_symmetric": { - "evaluated": 8319, - "inliers": 7055, - "inlier_ratio": 0.8480586608967424, - "inlier_rmse_m": 0.09667505139943416, - "median_m": 0.07870867553207189, - "p90_m": 0.3965312515634948, - "p95_m": 0.7427693214426566 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 48023.69053366773, - 97847.04258204983, - 200153.70215108668, - 424975.7238763227, - 625756.4174474803, - 1083954.430572844 - ], - "effective_rank": 6, - "scaled_condition_number": 22.5712438700004, - "weakest_scaled_direction": [ - -0.07389389496011048, - -0.5946842246250003, - 0.02763114388596392, - 0.12254120404962042, - -0.07607012120255037, - 0.7869713305627076 - ] - }, - "forward_reverse": { - "translation_m": 0.01573204986385798, - "rotation_deg": 0.04061482397026774 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.22614398128331e-15, - "rotation_deg": 1.9505961720268953e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 46130, - "frame_counter_j": 48071, - "rtk_translation_m": 0.8427696971904044, - "rtk_rotation_deg": 82.02000275788396, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.093209226820172, - 0.9956453621949153, - -0.0015338759213878196, - -0.3095968113864086 - ], - [ - -0.9953735556389727, - 0.09314748636970821, - -0.023559085670590403, - -1.2832519079412938 - ], - [ - -0.023313617698995717, - 0.0037227036897267167, - 0.9997212695081682, - -0.0032746774984088738 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9084, - "backend_objective": 863.8759803915655, - "backend_elapsed_sec": 0.12028999999893131, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3411, - "objective": 544.0783146618197 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6485, - "objective": 505.1487534124952 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9084, - "objective": 863.8759803915655 - } - ], - "heldout_symmetric": { - "evaluated": 8351, - "inliers": 7246, - "inlier_ratio": 0.867680517303317, - "inlier_rmse_m": 0.0986734040048058, - "median_m": 0.07440986859673626, - "p90_m": 0.3283754061384697, - "p95_m": 0.6753386014674962 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50197.336596780064, - 82483.2917170837, - 198878.86566349425, - 399463.60367839463, - 768159.5909005555, - 1172976.7954978498 - ], - "effective_rank": 6, - "scaled_condition_number": 23.367311395821964, - "weakest_scaled_direction": [ - -0.46776742902342217, - 0.40628421437536333, - -0.04120640554291039, - -0.160018994119871, - -0.07920711094361334, - -0.7632489480721708 - ] - }, - "forward_reverse": { - "translation_m": 0.002023273028745447, - "rotation_deg": 0.014811950864385802 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.1777673608052093e-16, - "rotation_deg": 5.054808181975537e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784258660.65995, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 46130, - "frame_counter_j": 48989, - "rtk_translation_m": 1.1320092061720382, - "rtk_rotation_deg": 147.1799498371321, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8397852212028346, - 0.5415067859288281, - -0.039130334043302906, - -1.2880627868349586 - ], - [ - -0.5409549870565313, - -0.8406961374187052, - -0.02444803689330013, - -0.39664418337450114 - ], - [ - -0.04613549856646882, - 0.0006366492754976053, - 0.9989349880996856, - -0.06571410253273094 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8619, - "backend_objective": 1348.573776000168, - "backend_elapsed_sec": 0.1769588000024669, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 3608, - "objective": 514.3371524594083 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6447, - "objective": 539.0297368876071 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8619, - "objective": 1348.573776000168 - } - ], - "heldout_symmetric": { - "evaluated": 8417, - "inliers": 6730, - "inlier_ratio": 0.7995722941665676, - "inlier_rmse_m": 0.10006346131537393, - "median_m": 0.08574954300778133, - "p90_m": 0.5634123372167124, - "p95_m": 0.9873414162602915 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26346.891994961083, - 95386.93253876397, - 171555.33657758404, - 380589.53688087256, - 590778.2339301979, - 1098369.1465294538 - ], - "effective_rank": 6, - "scaled_condition_number": 41.688755802373954, - "weakest_scaled_direction": [ - -0.597369263876027, - -0.2946683543848656, - -0.061992698467671956, - 0.09838488199475992, - -0.0735195313955241, - -0.733070748519735 - ] - }, - "forward_reverse": { - "translation_m": 0.00887908049317058, - "rotation_deg": 0.048438711468841336 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.516090631213609e-15, - "rotation_deg": 8.138729122870726e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784258854.752906, - "frame_counter_i": 47324, - "frame_counter_j": 48071, - "rtk_translation_m": 0.2771314063233405, - "rtk_rotation_deg": 58.9616360774086, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4704223425402732, - 0.8824404391971766, - -0.0013003493437417847, - -0.9246092736675245 - ], - [ - -0.8820592888741405, - 0.4701747728009043, - -0.0301180001405255, - -1.0338151393802915 - ], - [ - -0.025965949814490356, - 0.015315165396163111, - 0.9995455042963873, - -0.07117699009666004 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 9015, - "backend_objective": 819.1832088148524, - "backend_elapsed_sec": 0.09307049999915762, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3499, - "objective": 448.9967334063442 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6584, - "objective": 511.252147860645 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 9015, - "objective": 819.1832088148524 - } - ], - "heldout_symmetric": { - "evaluated": 8230, - "inliers": 6984, - "inlier_ratio": 0.8486026731470231, - "inlier_rmse_m": 0.09714101002609693, - "median_m": 0.0779635008224315, - "p90_m": 0.38331358182581793, - "p95_m": 0.6010112349567066 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41672.87479768214, - 107505.45647398855, - 147161.32344480747, - 252845.1469530831, - 738246.6421586989, - 1142369.4655629082 - ], - "effective_rank": 6, - "scaled_condition_number": 27.412782801978597, - "weakest_scaled_direction": [ - 0.43125150612334523, - -0.4617735487427605, - 0.04452414866242725, - 0.07739253348994116, - 0.07912232183775593, - 0.7658687761495183 - ] - }, - "forward_reverse": { - "translation_m": 0.012921368358244189, - "rotation_deg": 0.05809273577687571 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1734582967227625e-15, - "rotation_deg": 1.488714270560422e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 47324, - "frame_counter_j": 48989, - "rtk_translation_m": 0.5409306841643147, - "rtk_rotation_deg": 124.12158315665668, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6076954465369467, - 0.778878426981013, - 0.1550955842112933, - 0.42830163876841654 - ], - [ - -0.7824206688625193, - -0.6206456295080803, - 0.05115564005316087, - 0.2233101272667619 - ], - [ - 0.13610342095255418, - -0.09026294121123407, - 0.986574102766189, - -1.0667289338423123 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 575, - "backend_objective": 13.478393875353898, - "backend_elapsed_sec": 0.24855270000261953, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 1343, - "objective": 1111.1747662504722 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 28, - "num_inliers": 794, - "objective": 63.98432981897716 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 575, - "objective": 13.478393875353898 - } - ], - "heldout_symmetric": { - "evaluated": 8296, - "inliers": 653, - "inlier_ratio": 0.07871263259402121, - "inlier_rmse_m": 0.14967084978243636, - "median_m": 1.5952770707144013, - "p90_m": 3.0051963942258966, - "p95_m": 3.5412728861666882 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 123.88391626183476, - 286.3585681034317, - 521.989797713704, - 1837.8619701401135, - 3290.4751209801716, - 4099.469068839084 - ], - "effective_rank": 6, - "scaled_condition_number": 33.0912130689722, - "weakest_scaled_direction": [ - -0.6957308101220805, - -0.6636381961458412, - 0.09812921082246813, - 0.06524177216353211, - -0.07389738828394256, - -0.23705765040660567 - ] - }, - "forward_reverse": { - "translation_m": 2.900706563387122, - "rotation_deg": 12.11541439568944 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2119809348894873e-15, - "rotation_deg": 5.885321930804881e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 31, - "j": 34, - "lidar_time_i": 1784258780.056085, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 47324, - "frame_counter_j": 49755, - "rtk_translation_m": 0.9901318542574941, - "rtk_rotation_deg": 155.5976733552555, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9126871551547734, - 0.4063246717913732, - -0.043616715936892675, - -1.9302238581070268 - ], - [ - -0.40596412306963026, - -0.9137266158119328, - -0.01722795220506652, - 0.24652381842111304 - ], - [ - -0.0468538962712084, - 0.001983091149313248, - 0.998899784639931, - -0.06324253804208833 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8207, - "backend_objective": 482.52483420392747, - "backend_elapsed_sec": 0.08593600000313018, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3272, - "objective": 513.6461105157824 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5996, - "objective": 477.3959338250617 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8207, - "objective": 482.52483420392747 - } - ], - "heldout_symmetric": { - "evaluated": 8296, - "inliers": 6482, - "inlier_ratio": 0.7813404050144648, - "inlier_rmse_m": 0.09211161518215291, - "median_m": 0.08128005787563564, - "p90_m": 0.7035690034397544, - "p95_m": 1.7124631109821618 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 62480.453015231564, - 85819.91849187115, - 117865.14070874055, - 288709.20644362655, - 589387.439273466, - 1082008.0559427289 - ], - "effective_rank": 6, - "scaled_condition_number": 17.31754498769328, - "weakest_scaled_direction": [ - -0.36287669904892594, - -0.4944503039267934, - -0.048343050149538824, - 0.12418610593180494, - -0.11895133953015959, - -0.769370351426263 - ] - }, - "forward_reverse": { - "translation_m": 3.351107529092291, - "rotation_deg": 8.098567652508597 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 3.5593287521147166, - "rotation_deg": 4.16567569301089 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784258946.5498006, - "frame_counter_i": 48071, - "frame_counter_j": 48989, - "rtk_translation_m": 0.38765596924480794, - "rtk_rotation_deg": 65.15994707924807, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4608212080257616, - 0.8874902836209366, - -0.0021933335605390115, - -0.9749353662270557 - ], - [ - -0.8872959280904505, - 0.46066539879936474, - -0.02221095097308647, - -0.9005084537231612 - ], - [ - -0.01870161029922948, - 0.012181413196029054, - 0.9997509004470881, - -0.024862260604689438 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 9298, - "backend_objective": 631.1894543053492, - "backend_elapsed_sec": 0.07672319999983301, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3657, - "objective": 500.2874261018309 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6757, - "objective": 453.0392733041902 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 9298, - "objective": 631.1894543053492 - } - ], - "heldout_symmetric": { - "evaluated": 8328, - "inliers": 7156, - "inlier_ratio": 0.8592699327569645, - "inlier_rmse_m": 0.08972486966187442, - "median_m": 0.07096042090592512, - "p90_m": 0.3675544291139577, - "p95_m": 0.7537617219357211 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53302.82599480226, - 90231.25792519412, - 237425.56127762614, - 545966.6867322427, - 784930.3955077782, - 1209139.8446297306 - ], - "effective_rank": 6, - "scaled_condition_number": 22.68434781952533, - "weakest_scaled_direction": [ - 0.57210056488125, - 0.2693326824278414, - 0.033759510668809584, - -0.06503653368021872, - 0.13051835305845236, - 0.7601028575659693 - ] - }, - "forward_reverse": { - "translation_m": 0.0035725430520846596, - "rotation_deg": 0.009168450597030125 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.927525833688517e-16, - "rotation_deg": 3.3045052048349606e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 48071, - "frame_counter_j": 49755, - "rtk_translation_m": 1.0327853226589305, - "rtk_rotation_deg": 96.63603727784675, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.0717765001150436, - 0.9973914294486579, - -0.007646600133288951, - -1.6176153921311207 - ], - [ - -0.995955816070957, - -0.07208432455020328, - -0.05362706955051733, - -0.267946520560158 - ], - [ - -0.05403837956184667, - 0.0037665125121559262, - 0.9985317555880858, - -0.01907577091576432 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8606, - "backend_objective": 1027.3778426034853, - "backend_elapsed_sec": 0.10111009999673115, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3267, - "objective": 524.7779871967447 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6123, - "objective": 533.4601909627082 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8606, - "objective": 1027.3778426034853 - } - ], - "heldout_symmetric": { - "evaluated": 8328, - "inliers": 6936, - "inlier_ratio": 0.8328530259365994, - "inlier_rmse_m": 0.09815070141607997, - "median_m": 0.0832183490255524, - "p90_m": 0.5020475841958456, - "p95_m": 1.1838794666422094 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44165.206652076195, - 81332.72425879547, - 141432.17471413853, - 341822.15389272576, - 645412.8085175732, - 1056755.3521389745 - ], - "effective_rank": 6, - "scaled_condition_number": 23.927327238925002, - "weakest_scaled_direction": [ - -0.2593180412671107, - -0.6006960695193027, - -0.04224110777772633, - 0.13919986523574893, - -0.014530730111291199, - -0.7419880927292174 - ] - }, - "forward_reverse": { - "translation_m": 0.04150636593087017, - "rotation_deg": 1.4498937658029205 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5991563205864272e-15, - "rotation_deg": 1.3863332865978313e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 32, - "j": 35, - "lidar_time_i": 1784258854.752906, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 48071, - "frame_counter_j": 50767, - "rtk_translation_m": 1.1947451269258382, - "rtk_rotation_deg": 131.6892972449946, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6226534351500811, - 0.7818871947709687, - -0.030904924348551265, - -1.7246023286165766 - ], - [ - -0.7811177746812105, - -0.623414954010243, - -0.034768048456615006, - 0.1428508074850736 - ], - [ - -0.04645128386684595, - 0.002491940928855679, - 0.9989174482696396, - -0.07324348266714298 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8391, - "backend_objective": 780.3296919976844, - "backend_elapsed_sec": 0.11109460000443505, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 22, - "num_inliers": 3446, - "objective": 566.1271025060753 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6254, - "objective": 504.57406856138164 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8391, - "objective": 780.3296919976844 - } - ], - "heldout_symmetric": { - "evaluated": 8432, - "inliers": 6772, - "inlier_ratio": 0.8031309297912713, - "inlier_rmse_m": 0.09391797152520207, - "median_m": 0.0769373882990903, - "p90_m": 0.549912470874396, - "p95_m": 1.3673219109504064 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33606.06796820574, - 80643.53119304721, - 96889.17796657849, - 322339.1362489655, - 563046.3794084276, - 1038297.5480992158 - ], - "effective_rank": 6, - "scaled_condition_number": 30.896133075774756, - "weakest_scaled_direction": [ - -0.1588358297131209, - 0.6439593861192452, - 0.024486338719113782, - -0.1447001895111971, - -0.016974856763868045, - 0.7336631494341744 - ] - }, - "forward_reverse": { - "translation_m": 0.007719527793580684, - "rotation_deg": 0.006042163579184511 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 1.0960848473449323, - "rotation_deg": 0.9566471513657346 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "multistart_instability" - ] - }, - { - "i": 33, - "j": 34, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259023.1457825, - "frame_counter_i": 48989, - "frame_counter_j": 49755, - "rtk_translation_m": 0.7453275493729801, - "rtk_rotation_deg": 31.47609019859864, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8514050006744601, - 0.5244616476975956, - 0.007035973340368781, - -0.831982917238867 - ], - [ - -0.5244771946684533, - 0.851424384061677, - 0.0004364606553915362, - -0.28523240834574026 - ], - [ - -0.005761692393116058, - -0.004061812343916656, - 0.9999751519819131, - -0.05221941929087148 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 9152, - "backend_objective": 1249.8574590465687, - "backend_elapsed_sec": 0.09977049999724841, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3436, - "objective": 579.5561701278207 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6447, - "objective": 741.72228137809 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 9152, - "objective": 1249.8574590465687 - } - ], - "heldout_symmetric": { - "evaluated": 8394, - "inliers": 7283, - "inlier_ratio": 0.8676435549201811, - "inlier_rmse_m": 0.0964383255266311, - "median_m": 0.07584690944515675, - "p90_m": 0.3356376634083298, - "p95_m": 0.7216635052824919 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41848.59336122196, - 104417.0868181879, - 293671.71378884243, - 632522.7440898115, - 674307.1714121009, - 1123038.1821391163 - ], - "effective_rank": 6, - "scaled_condition_number": 26.835745049910184, - "weakest_scaled_direction": [ - 0.32100595136253307, - 0.5747317866986112, - 0.06098791165090659, - -0.13656908012183502, - -0.01761612598919143, - 0.737534803002765 - ] - }, - "forward_reverse": { - "translation_m": 0.02602048161602559, - "rotation_deg": 1.951142742234491 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.495761671766055e-16, - "rotation_deg": 7.550110339320766e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 33, - "j": 35, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 48989, - "frame_counter_j": 50767, - "rtk_translation_m": 1.0924186931915323, - "rtk_rotation_deg": 66.52935016574651, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4071191077317827, - 0.9133731131403605, - -0.001894284024159519, - -1.2700919775050272 - ], - [ - -0.9129812140460937, - 0.4068817763206014, - -0.030207993927318093, - -0.18443003796691126 - ], - [ - -0.026820419806513836, - 0.014027697262182125, - 0.999541839439912, - -0.03548244548294059 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8860, - "backend_objective": 992.8873966559927, - "backend_elapsed_sec": 0.0989521999945282, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3617, - "objective": 636.9391930354458 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6536, - "objective": 454.50883796550505 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8860, - "objective": 992.8873966559927 - } - ], - "heldout_symmetric": { - "evaluated": 8498, - "inliers": 7078, - "inlier_ratio": 0.8329018592610026, - "inlier_rmse_m": 0.09179860947142506, - "median_m": 0.0738517024359357, - "p90_m": 0.4177647999028803, - "p95_m": 0.6762110121875847 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 60766.256240579605, - 99661.7559727482, - 164465.06831168922, - 609694.3884089764, - 653121.0263623493, - 1089818.5189093002 - ], - "effective_rank": 6, - "scaled_condition_number": 17.934600324801995, - "weakest_scaled_direction": [ - -0.301932403223447, - 0.5709106269942578, - 0.031179648910464926, - -0.09656829373119204, - -0.11780647506419582, - 0.7474770287047978 - ] - }, - "forward_reverse": { - "translation_m": 0.0072384331805243046, - "rotation_deg": 0.028209706778456432 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0264926492536447e-15, - "rotation_deg": 1.9854297292176543e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "lidar_time_i": 1784258946.5498006, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 48989, - "frame_counter_j": 51951, - "rtk_translation_m": 3.335020341384374, - "rtk_rotation_deg": 123.21987515531416, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5318696596194555, - 0.8466701205623128, - -0.01625952407923447, - -1.5506572921676944 - ], - [ - -0.8464549876732743, - -0.5321069626988371, - -0.01939417671506619, - 2.2136541884591185 - ], - [ - -0.025072275910281917, - 0.0034477810860199065, - 0.999679695595675, - -0.023905970672646572 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7458, - "backend_objective": 1036.654820929933, - "backend_elapsed_sec": 0.13642760000220733, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3182, - "objective": 654.3121938546817 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5537, - "objective": 454.0998246489015 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7458, - "objective": 1036.654820929933 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 6183, - "inlier_ratio": 0.760797342192691, - "inlier_rmse_m": 0.09861359027653524, - "median_m": 0.0885622089303868, - "p90_m": 0.6677795339136111, - "p95_m": 1.1743910552945616 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32985.408846064536, - 65370.97397523631, - 82547.23349223638, - 426505.2689052984, - 482496.5296617536, - 868278.9908510726 - ], - "effective_rank": 6, - "scaled_condition_number": 26.32312350297475, - "weakest_scaled_direction": [ - -0.5791874550072192, - 0.018025588464213205, - 0.02301991358423635, - -0.04998234133187691, - -0.11312059179582401, - 0.8052282601648431 - ] - }, - "forward_reverse": { - "translation_m": 0.0022735557932631, - "rotation_deg": 0.12221117701824208 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5980112069327407e-15, - "rotation_deg": 2.6495215403824894e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 35, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259124.3419108, - "frame_counter_i": 49755, - "frame_counter_j": 50767, - "rtk_translation_m": 0.6186130964444055, - "rtk_rotation_deg": 35.05325996714787, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8238888424265844, - 0.5667284728066836, - 0.005100336771940666, - -0.4249766980206035 - ], - [ - -0.5667345606553351, - 0.8239003872525498, - -0.0002994059172867393, - -0.14414538815094802 - ], - [ - -0.004371851299773524, - -0.0026438599250310025, - 0.9999869483752821, - 0.019750480534521386 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9263, - "backend_objective": 460.094755827139, - "backend_elapsed_sec": 0.09129399999801535, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3704, - "objective": 536.2869181993523 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6756, - "objective": 594.8138000616144 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9263, - "objective": 460.094755827139 - } - ], - "heldout_symmetric": { - "evaluated": 8498, - "inliers": 7350, - "inlier_ratio": 0.8649093904448105, - "inlier_rmse_m": 0.0788491357224537, - "median_m": 0.05680569635777885, - "p90_m": 0.3378538776376145, - "p95_m": 0.5995612734185298 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 55887.55259118495, - 116632.52345217524, - 183317.34964941538, - 676003.5039112171, - 780096.0956938936, - 1286853.069476995 - ], - "effective_rank": 6, - "scaled_condition_number": 23.02575456989985, - "weakest_scaled_direction": [ - -0.15452278100099642, - 0.6220733326192909, - 0.055383599601089996, - -0.11160570382060138, - -0.08667195065853928, - 0.7524043299547295 - ] - }, - "forward_reverse": { - "translation_m": 0.0032110784907267375, - "rotation_deg": 0.015379666997505564 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9570664059926654e-15, - "rotation_deg": 4.8894763516408376e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 49755, - "frame_counter_j": 51951, - "rtk_translation_m": 3.114273556969299, - "rtk_rotation_deg": 91.74378495671547, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.011137392375608434, - 0.9998780139010536, - -0.01095060767064822, - -1.9163681775205792 - ], - [ - -0.9999287752128017, - -0.011183604531494104, - -0.004167912080437608, - 1.7435874106290512 - ], - [ - -0.004289870918670234, - 0.010903408043720295, - 0.9999313539941295, - -0.034013897972021735 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7372, - "backend_objective": 820.4498232277847, - "backend_elapsed_sec": 0.1077618999988772, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3092, - "objective": 615.4324144816983 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5434, - "objective": 517.8693328742436 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7372, - "objective": 820.4498232277847 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 6282, - "inlier_ratio": 0.7729789590254706, - "inlier_rmse_m": 0.09845381444357724, - "median_m": 0.08712344185605007, - "p90_m": 0.7215830700120648, - "p95_m": 1.5600349023433386 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 25250.49247258991, - 61274.8002251948, - 124966.42831695636, - 485374.5083762247, - 550647.6387522393, - 932163.502039654 - ], - "effective_rank": 6, - "scaled_condition_number": 36.91664640012635, - "weakest_scaled_direction": [ - 0.5352473697232546, - -0.20633832792909085, - -0.03760757714456447, - 0.0453622117757219, - 0.10719563157480623, - -0.8099208505077351 - ] - }, - "forward_reverse": { - "translation_m": 0.011794412591703963, - "rotation_deg": 0.006135949966801849 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.483631417132112e-16, - "rotation_deg": 2.9710136984969784e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 37, - "lidar_time_i": 1784259023.1457825, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 49755, - "frame_counter_j": 52792, - "rtk_translation_m": 2.8155528331227235, - "rtk_rotation_deg": 126.08390993626574, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5971026902193718, - 0.8011285887519551, - -0.04075980393831611, - -2.20012451749622 - ], - [ - -0.8017190199166772, - -0.5976937397044704, - -0.002967595310759037, - 1.7416270947719277 - ], - [ - -0.02673930508880845, - 0.03090595092188607, - 0.9991645669062637, - -0.04436249626807182 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6973, - "backend_objective": 442.43304304647575, - "backend_elapsed_sec": 0.1320724000033806, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3114, - "objective": 769.8314942206106 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5245, - "objective": 503.95425280103353 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6973, - "objective": 442.43304304647575 - } - ], - "heldout_symmetric": { - "evaluated": 8177, - "inliers": 5911, - "inlier_ratio": 0.722881252293017, - "inlier_rmse_m": 0.09759501600127507, - "median_m": 0.09610550587511557, - "p90_m": 1.4068299664325443, - "p95_m": 2.745742945940053 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20525.0881721974, - 53917.61639346656, - 79386.95141697647, - 237545.78830971898, - 409776.23489298206, - 879057.8693451476 - ], - "effective_rank": 6, - "scaled_condition_number": 42.82845764024001, - "weakest_scaled_direction": [ - -0.5761303408652897, - -0.022842716386368922, - 0.030142774195291697, - 0.008635415745907468, - -0.09305932505333835, - 0.811115802719847 - ] - }, - "forward_reverse": { - "translation_m": 0.024742240312777743, - "rotation_deg": 0.08718512569927171 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.998455352335243e-14, - "rotation_deg": 3.329424406638837e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "lidar_time_i": 1784259124.3419108, - "lidar_time_j": 1784259242.7374756, - "frame_counter_i": 50767, - "frame_counter_j": 51951, - "rtk_translation_m": 2.4989423629184655, - "rtk_rotation_deg": 56.69052498956759, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5573093680969124, - 0.8301840676100748, - -0.014166231602364115, - -2.3000026811108962 - ], - [ - -0.8303021385034535, - 0.5571821766924262, - -0.01209879220758413, - 0.7155853348642858 - ], - [ - -0.0021510527683269937, - 0.018505022633922685, - 0.9998264534954584, - -0.05838570120135368 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7499, - "backend_objective": 672.3737075972551, - "backend_elapsed_sec": 0.09540149999520509, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3130, - "objective": 732.754520638991 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5497, - "objective": 591.4103608309011 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7499, - "objective": 672.3737075972551 - } - ], - "heldout_symmetric": { - "evaluated": 8231, - "inliers": 6334, - "inlier_ratio": 0.7695298262665533, - "inlier_rmse_m": 0.09495386680108024, - "median_m": 0.0831376106566306, - "p90_m": 0.790641222071479, - "p95_m": 1.5335092586167933 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33123.041808759015, - 60930.04724390777, - 101902.62161722827, - 449099.71241105546, - 497466.76166188467, - 926743.9256015598 - ], - "effective_rank": 6, - "scaled_condition_number": 27.978829086780696, - "weakest_scaled_direction": [ - -0.551669550718345, - 0.2068344048294598, - 0.04303908164793011, - -0.07579820003035191, - -0.11242117236279105, - 0.7953892041740949 - ] - }, - "forward_reverse": { - "translation_m": 0.006644101856716534, - "rotation_deg": 0.038610475450088305 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.3407826539173486e-11, - "rotation_deg": 7.122154446559147e-10 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "lidar_time_i": 1784259124.3419108, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 50767, - "frame_counter_j": 52792, - "rtk_translation_m": 2.2182956249874577, - "rtk_rotation_deg": 91.03064996911786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.03730371026296736, - 0.9991766678786611, - -0.015950535022899646, - -2.538218189961778 - ], - [ - -0.9992322901108363, - -0.03748746476077693, - -0.01138070233600765, - 0.5397175330308861 - ], - [ - -0.0119692773577974, - 0.015513747216893607, - 0.9998080115936377, - -0.11196108886797657 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7023, - "backend_objective": 815.1607150098368, - "backend_elapsed_sec": 0.1856597999940277, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 39, - "num_inliers": 3159, - "objective": 834.7266976363617 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 5363, - "objective": 1206.5805544802474 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7023, - "objective": 815.1607150098368 - } - ], - "heldout_symmetric": { - "evaluated": 8281, - "inliers": 5977, - "inlier_ratio": 0.7217727327617437, - "inlier_rmse_m": 0.10621413586570766, - "median_m": 0.10931778407927274, - "p90_m": 1.4870160227344433, - "p95_m": 2.8699645618067056 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24588.495253168316, - 47697.39902911076, - 65284.50277546982, - 222027.66654047518, - 382748.8516654366, - 799796.220570917 - ], - "effective_rank": 6, - "scaled_condition_number": 32.52725359303394, - "weakest_scaled_direction": [ - -0.5658761521092754, - -0.14003751136486609, - 0.028901874902001096, - -0.007360237529588878, - -0.13200244074975906, - 0.801161369545174 - ] - }, - "forward_reverse": { - "translation_m": 0.04503438705750094, - "rotation_deg": 1.5781812743250268 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.886119947416683e-16, - "rotation_deg": 1.3244603122813474e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 36, - "j": 37, - "lidar_time_i": 1784259242.7374756, - "lidar_time_j": 1784259326.8337293, - "frame_counter_i": 51951, - "frame_counter_j": 52792, - "rtk_translation_m": 0.5129211474320938, - "rtk_rotation_deg": 34.34012497955026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8083554036087096, - 0.5886947221586053, - -0.00025604531510284247, - 0.0037240617105741367 - ], - [ - -0.5884532447515701, - 0.8080112126938198, - -0.02899411841065784, - -0.28467989527003845 - ], - [ - -0.016861796996435082, - 0.023588222986601726, - 0.9995795493798308, - -0.02205466024106569 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9027, - "backend_objective": 713.3293832483491, - "backend_elapsed_sec": 0.08661949999805074, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 3654, - "objective": 446.5276364539395 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 1, - "num_inliers": 6536, - "objective": 438.02683082607507 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9027, - "objective": 713.3293832483491 - } - ], - "heldout_symmetric": { - "evaluated": 7910, - "inliers": 6949, - "inlier_ratio": 0.8785082174462705, - "inlier_rmse_m": 0.08834636280188386, - "median_m": 0.06580646046450866, - "p90_m": 0.329639908182268, - "p95_m": 1.0302131665838532 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 45572.18757473022, - 144344.45333491915, - 205001.56146385125, - 489904.6197876151, - 694163.988833144, - 1062963.2657793977 - ], - "effective_rank": 6, - "scaled_condition_number": 23.324824248042262, - "weakest_scaled_direction": [ - 0.6253460402863806, - 0.027816479782608927, - -0.03132780481808471, - -0.02425124339104761, - 0.07604584796306675, - -0.7751232471017077 - ] - }, - "forward_reverse": { - "translation_m": 0.003787237363253161, - "rotation_deg": 0.027331592166342466 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5146981355543298e-15, - "rotation_deg": 8.37405761275949e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - } - ] -} diff --git a/results/01_previous_two_batches/small_gicp/B_batch2_estimation.npz b/results/01_previous_two_batches/small_gicp/B_batch2_estimation.npz deleted file mode 100644 index de582af..0000000 Binary files a/results/01_previous_two_batches/small_gicp/B_batch2_estimation.npz and /dev/null differ diff --git a/results/01_previous_two_batches/small_gicp/B_batch2_quality.csv b/results/01_previous_two_batches/small_gicp/B_batch2_quality.csv deleted file mode 100644 index 1bd5b46..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch2_quality.csv +++ /dev/null @@ -1,176 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,0.503306788400079,13.198324485965863,0.8131655372700871,0.09008834340898543,6,11.429289586039127,0.0005504552049968047,0.0032916777115618487,1.0,True, -0,2,1.1601020961002007,26.306295080591493,0.8167658604533367,0.09980570916927256,6,11.00789089021616,0.00205395151868756,0.012799633971915293,1.0,True, -0,3,1.1328421148283978,41.74134818989305,0.81441508497705,0.10115686777955255,6,13.837529680361882,0.01247476852224996,0.1726729736128094,1.0,True, -0,4,1.0129799192122786,70.92934830291522,0.7761963190184049,0.10269905695661055,6,12.888313335228592,0.019300920937430674,0.12217052794626229,1.0,True, -0,5,0.9014321094792815,89.27285808969826,0.7735100978813034,0.10986502690369805,6,24.919203290408266,0.0278108340699398,0.2717481445912482,1.0,True, -1,2,0.6927979865343085,13.107970594625625,0.7850287907869482,0.08649388452503427,6,11.757459931907107,0.001960394451155616,0.002128143929965857,1.0,True, -1,3,0.7002295454253883,28.543023703927183,0.7901992730918661,0.09109387779670658,6,12.066030386554463,0.004906057223105903,0.018773640398341965,1.0,True, -1,4,0.8045641659338967,57.731023816949346,0.7439266236985622,0.09680131928922782,6,12.860596463339792,0.020081946886066578,1.2340284819813434,1.0,False,forward_reverse_rotation -1,5,0.7829726518389362,76.07453360373235,0.7313806483915384,0.10148815288043825,6,12.782489568272775,0.016729134900242502,0.06734086907642674,1.0,True, -1,6,0.7843480712672012,108.63393511864574,0.6214689265536724,0.10742176387842234,6,26.39069479810122,0.0027238824581310127,0.04004688680398286,1.0,True, -2,3,0.13949776780243606,15.435053109301553,0.9176300578034682,0.07082931569628453,6,11.740335220665598,0.0016419682635548487,0.0015051284247814798,1.0,True, -2,4,0.6701726006967371,44.62305322232371,0.840540189585768,0.08212714345330237,6,12.917292889611646,0.0015059170263523442,0.004861145455894842,1.0,True, -2,5,0.8004226998626774,62.96656300910673,0.8300970873786407,0.0931389934573794,6,15.74858194202481,0.002555949510569182,0.008486377461290648,1.0,True, -2,6,1.3845111356101025,95.5259645240201,0.6495130297446696,0.10354826871538153,6,15.262952717632835,0.008359384079660144,0.07441619593698878,1.0,True, -2,7,2.161304865409727,119.81081101983789,0.8143257302921169,0.09968516416989152,6,30.540416925007207,0.013121403719342412,0.05039604031914888,1.0,True, -3,4,0.5366157827594368,29.188000113022152,0.8855689764780674,0.07250679559229746,6,11.672391892657863,0.0006574625393083392,0.0008548453445728261,1.0,True, -3,5,0.6760093701980526,47.53150989980517,0.8759311584895967,0.08543306637795112,6,15.073465050917047,0.0011073394938326227,0.004974962253885575,1.0,True, -3,6,1.4361364806393455,80.09091141471853,0.678819891780469,0.10239967326707564,6,23.156860004682848,0.002691305620040523,0.027681404773136364,1.0,True, -3,7,2.1008551524156123,104.37575791053635,0.7961101683853283,0.10180989325686585,6,29.756525470837225,0.023292005056525338,0.174639961337377,1.0,True, -3,8,1.3108481779402037,133.20736428981294,0.11556480999479438,0.1433106939673773,6,147.35707874920627,1.368389528072986,15.0277123732284,1.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation -4,5,0.17861948949299924,18.343509786783002,0.8685714285714285,0.07604325543622346,6,12.370184068840063,0.003904582263467037,0.011742002375313174,1.0,True, -4,6,1.5807073315069207,50.90291130169636,0.6822060883963826,0.10567824422734254,6,18.163522769519293,0.011923922180697284,0.08008579261790838,1.0,True, -4,7,1.7804201387535592,75.18775779751417,0.7963870967741935,0.10178391918503964,6,25.315987799570973,0.034377900701078094,0.11532260919614924,1.0,True, -4,8,1.2818497736845669,104.01936417679076,0.7430850379518847,0.10189238984319506,6,25.19640114706588,0.034977663635135596,1.5753470469755222,1.0,False,forward_reverse_rotation -4,9,1.5141865499370524,117.34615495378958,0.0841833440929632,0.15176056899798168,6,84.88516221869183,3.340127368239112,6.177861200193235,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -5,6,1.5316987521992935,32.55940151491337,0.6864384971693258,0.10315026388508003,6,11.505426214947052,0.002552272421554712,0.013899678900349944,1.0,True, -5,7,1.6091514152462776,56.844248010731185,0.8104549602398644,0.09862238510016193,6,16.517299930207333,0.0037398303757535147,0.02129636862756259,1.0,True, -5,8,1.1872485760158462,85.67585439000777,0.7806082661814401,0.10305777405801758,6,17.737819341361416,0.0056799616182010805,0.026182015145595202,1.0,True, -5,9,1.380208837139288,99.00264516700663,0.7946777980693973,0.10313535699942489,6,14.147499646203187,0.06270036555847405,0.33857191756776234,1.0,True, -5,10,1.7506315276318887,115.10127466723206,0.7847418443359877,0.10018431236036145,6,21.425526326745782,0.005291671170548772,0.044796841001461946,1.0,True, -6,7,1.5692385974903325,24.284846495817817,0.7380672159016608,0.1046107504689679,6,13.947054238965462,0.010178220865611676,0.026255002379027764,1.0,True, -6,8,0.5035712140385419,53.11645287509441,0.7026075619295958,0.10337241424878332,6,21.232848227388097,0.017447450845101884,0.1292664848366822,1.0,True, -6,9,0.8508108569116883,66.44324365209327,0.6714210939544621,0.10949604778423808,6,34.21205543097956,0.09491078892598759,0.32255986251320673,1.0,False,forward_reverse_translation -6,10,1.3331914459292633,82.5418731523187,0.6619427982478743,0.10510077922086615,6,31.101566437428897,0.003562383894956786,0.04536548719264196,1.0,True, -6,11,3.16887584646763,119.46156331049859,0.638006230529595,0.1061575017783152,6,31.943306843588733,0.0059304520508679575,0.05963953472442965,1.0,True, -7,8,1.1230406357307108,28.831606379276582,0.8040692297529396,0.09680052952350976,6,22.21980394474879,0.008328073875015064,0.06350723756646647,1.0,True, -7,9,0.7186795671679719,42.158397156275456,0.8274764620076913,0.09296346258223728,6,22.096355228992984,0.0076981468910999155,0.020277033650542,1.0,True, -7,10,0.39293571356254015,58.25702665650087,0.7992429186790236,0.10479299924479576,6,30.246845596558646,0.04240408437264065,1.1111803590641476,1.0,False,forward_reverse_rotation -7,11,2.4544901278439815,95.17671681468076,0.7502523977788995,0.1028589368143411,6,19.931284665592216,0.005620519728387707,0.0303880139721275,1.0,True, -7,12,3.0905023273107046,115.3786462164333,0.7054418372441338,0.10706084863640537,6,10.761985004268995,0.004629206980441498,0.07009059694702204,1.0,True, -8,9,0.4407680716864947,13.326790776998866,0.8539132734003173,0.09158655960119419,6,31.292808872701826,0.0036696927581956673,0.014909075167693285,1.0,True, -8,10,0.968166048306331,29.425420277224287,0.7989328474752733,0.09757506446655329,6,25.45934970841849,0.008689580645481346,0.052297435035790506,1.0,True, -8,11,3.0540124804140354,66.34511043540417,0.6854158802063672,0.10755838259974337,6,42.46956117899474,0.00234148729464824,0.061662020462905004,1.0,True, -8,12,3.652970846697932,86.5470398371567,0.6485376477909147,0.11031208403019,6,30.049664340525695,0.013830104055554564,0.11563630256710061,1.0,True, -8,13,4.357531202056024,107.49623325505803,0.622879241516966,0.1149201207874094,6,27.04257772502661,0.005835943764379069,0.23887217550290574,1.0,True, -9,10,0.5276649044820116,16.098629500225417,0.8486154649947754,0.09691837979566219,6,22.577834737399076,0.007052114296262031,0.2907164943632002,1.0,True, -9,11,2.680593454060616,53.0183196584053,0.6963000378835712,0.10535088240045436,6,39.530571540955094,0.0034527207661208545,0.020238883727394828,1.0,True, -9,12,3.2944321799753977,73.22024906015783,0.6584238791057825,0.10587631557960675,6,33.498316372288826,0.009482405807021465,0.07225186033919398,1.0,True, -9,13,4.1147924441994315,94.16944247805917,0.621557336004006,0.11335203160746431,6,32.6975845279655,0.009011781776631502,0.0416830306778097,1.0,True, -9,14,3.748520283907519,169.69584626488452,0.048890560361037984,0.15557197380465354,6,51.54107837707314,1.0864076801076206,7.184564913859941,0.5,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation -10,11,2.249454986440387,36.91969015817989,0.7156362731683045,0.10422606491110974,6,45.45254669271086,0.004301999273657816,0.02361974788713562,1.0,True, -10,12,2.8783779741216167,57.12161955993242,0.692875599852344,0.10691573133186853,6,39.11010182412513,0.004231594662123499,0.01872424915403812,1.0,True, -10,13,3.84803303865234,78.07081297783375,0.6594721262950173,0.10871022234744057,6,43.1464607017966,0.006980776690426113,0.21408921607631748,1.0,True, -10,14,3.3834992499807997,153.59721676465847,0.062245276028158575,0.15570919185507412,6,59.4104405367878,0.09444016841800375,2.8556589503073977,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -10,15,1.4957886147833104,171.72980583515965,0.6232518545542989,0.10969245891269987,6,43.00146365447724,3.0001452916434883,4.8522273147326915,1.0,False,forward_reverse_translation;forward_reverse_rotation -11,12,0.636223282239137,20.20192940175253,0.8688915375446961,0.08660981428891965,6,18.033297623211222,0.005089530929434581,0.03170796903435614,1.0,True, -11,13,2.0145868546459504,41.151122819653864,0.8021741727392188,0.10650327571539893,6,18.339724002801702,0.04485533499047456,0.27313934813876123,1.0,True, -11,14,1.2405786051647103,116.67752660647822,0.7455741626794259,0.11063741423489376,6,20.694961222671232,0.007044503253911164,0.40985193451245056,1.0,True, -11,15,1.4202907399288436,151.3505040066613,0.7466415272213057,0.10329430650455694,6,27.704214205277534,0.13203399207663835,1.4478079414864902,0.5,False,forward_reverse_translation;forward_reverse_rotation -11,16,2.7368971716016928,176.81389445065594,0.78639603721155,0.10318237166131629,6,34.658693494341755,0.008767229441137649,0.032548654712657686,1.0,True, -12,13,1.5928240921286525,20.949193417901323,0.8217283366828231,0.10684146627686454,6,16.400323597466677,0.01763325318199382,0.09467538550034012,1.0,True, -12,14,0.6774809171975742,96.47559720472566,0.7611268939393939,0.10826784336909262,6,10.635638995146312,0.0015931090432955832,0.024585439481643892,1.0,True, -12,15,1.8892292086221258,131.14857460490867,0.7324469325868906,0.11113399174419211,6,19.970471882560926,0.0024416100752998565,0.009279978214820864,1.0,True, -12,16,3.349436875941103,156.6119650489076,0.7500298864315601,0.10525785108693746,6,30.70828038440084,0.0024719134275639418,0.013160987022490347,1.0,True, -12,17,6.51378754358264,111.73754176984298,0.6198434030618207,0.1221546776649581,6,23.54160456185754,0.013538123192296372,0.06236055877935909,1.0,True, -13,14,0.9721300146850552,75.52640378682433,0.8278562107011508,0.10919246415865995,6,12.723402368483741,0.0049872211162087675,0.02566897887278044,1.0,True, -13,15,2.426469315960194,110.19938118700728,0.7886616014026885,0.10800229196760061,6,13.66454080002457,0.0038816141140735755,0.020030260506224723,1.0,True, -13,16,4.157137927296689,135.66277163100625,0.7477833692786964,0.10901310110319071,6,21.034367079780026,0.0024107551433002806,0.01470679715840447,1.0,True, -13,17,6.347445048137873,90.78834835194164,0.6122042632935114,0.12126385638135445,6,27.550293797111443,0.010111269848200304,1.6132660739833655,1.0,False,forward_reverse_rotation -13,18,4.26917989710959,135.79234683500215,0.6756988719960765,0.1140499722068077,6,13.668694297489541,0.010188526275029454,0.05757819838859875,1.0,True, -14,15,2.176233486689304,34.672977400182965,0.7415730337078652,0.11426627617931512,6,13.437209845730706,0.009280638111078932,0.07287904157175247,1.0,True, -14,16,3.79947855245853,60.13636784418198,0.7130173965206958,0.11194096137848975,6,36.60672565292038,0.0004016408999195087,0.020284570842973915,1.0,True, -14,17,6.190474035537447,15.261944565117341,0.6118212736015011,0.11991020962112661,6,17.152314443231333,0.020151321868834806,0.2079666531947748,1.0,True, -14,18,4.170672674565236,60.26594304817776,0.6756292203806016,0.1138218459710723,6,11.041435170572107,0.023698120255922432,0.1321697884270417,1.0,True, -14,19,3.9999134794649294,94.30913149027137,0.6699172941612147,0.112413086617321,6,9.748384934395327,0.018186549996561333,1.2493862686891326,1.0,False,forward_reverse_rotation -15,16,1.7328875589135755,25.463390443999018,0.7714218177520388,0.10015132538295435,6,21.49868629780701,0.007439481433750378,0.036349268136368934,1.0,True, -15,17,8.352264787019024,19.411032835065622,0.5587657459840518,0.12832496127520593,6,38.53228682833441,0.005430301274456062,0.06530638270069017,1.0,True, -15,18,6.346037230040679,25.592965647994788,0.615040502962157,0.11840729454457544,6,21.032065383701333,0.012871328625232324,0.037753566213482644,1.0,True, -15,19,5.607512178689573,59.636154090088375,0.6234350309955026,0.11735435665832353,6,16.270394372537467,0.007833445352022574,0.016491686030251827,1.0,True, -15,20,8.633248754322691,149.96154617253603,0.5562658304185261,0.13192141621005607,6,26.944324835385952,0.023510650105734523,0.673469393155776,1.0,False,forward_reverse_rotation -16,17,9.849975560032544,44.87442327906463,0.5900047370914259,0.1265936504427481,6,90.52736834449948,0.011296955150750666,0.21501790849158783,1.0,True, -16,18,7.9099649541476005,0.12957520399577063,0.6471098982882659,0.12019779875781794,6,38.44752656622707,0.016821400599454826,0.06522344447557246,1.0,True, -16,19,6.609737623005951,34.172763646089344,0.6280868046894488,0.12242728727104996,6,33.04590657073916,0.06745241310870236,1.6183598806956783,1.0,False,forward_reverse_rotation -16,20,9.541288639020653,124.49815572853673,0.5791883197228409,0.127436475456937,6,40.945151692592816,2.599521231663455,5.87323656621683,1.0,False,forward_reverse_translation;forward_reverse_rotation -16,21,9.407850320517097,175.38299577015903,0.49424730531670097,0.13389808634231865,6,45.28912477989511,0.04478742358365585,0.10475809279093058,1.0,True, -17,18,2.081596655954183,45.003998483060414,0.7629028349890962,0.10358638519274684,6,18.62989302843653,0.007136146106563684,0.13887814859043496,1.0,True, -17,19,4.34928579963815,79.047186925154,0.6728380024360536,0.10727518915463004,6,33.81541258417489,0.0017207670327870018,0.035486867252565536,1.0,True, -17,20,4.4206846692505035,169.37257900760153,0.6354846507130771,0.11168219002675635,6,38.40506040461897,0.020290214498459216,0.2831192364677464,1.0,True, -17,21,6.400116212709096,139.7425809507742,0.5695348561959995,0.1231813524465837,6,57.78224861663297,0.009859208985419086,0.31053558178227947,1.0,True, -17,22,8.798226453379533,96.08482130259475,0.5459048079246195,0.1287223998113377,6,62.758312260043155,0.03194615937469955,0.5773515871730924,1.0,False,forward_reverse_rotation -18,19,3.459222336215112,34.04318844209358,0.7562595809913132,0.11139160446923307,6,9.605522638453952,0.013156152321531143,0.09121207325672914,1.0,True, -18,20,4.94806857498194,124.36858052454107,0.6668778509883426,0.1149564835181103,6,18.76442873201715,0.0076759006397633354,0.11713903044228172,1.0,True, -18,21,6.5847443121227816,175.25342056617163,0.5977438948803768,0.12625086545570646,6,26.666713369082085,0.021119392446408227,0.18202979634982344,1.0,True, -18,22,9.20681259274594,141.08881978565523,0.5286220871327254,0.13561310095446666,6,65.22594013516775,0.03713510940704989,0.6483189610135184,1.0,False,forward_reverse_rotation -18,23,13.164275822166362,109.14103513098563,0.47146496815286626,0.14168298172295804,6,112.91469628781756,0.01208598984738065,0.6082838532521024,1.0,False,forward_reverse_rotation -19,20,3.031758915138065,90.32539208244746,0.7409531090723751,0.11651827109675585,6,10.060869835729363,0.0051743650857167135,0.07263138471648796,1.0,True, -19,21,3.732423384308353,141.21023212407198,0.6563629565000623,0.12291187901196955,6,15.339627619255575,0.0075358808329252175,0.06620678153945667,1.0,True, -19,22,6.37255124464243,175.13200822775684,0.5891492613346918,0.12519472268444526,6,28.30213785955742,0.010212573357042046,0.11056129275235052,1.0,True, -19,23,10.37094757900695,143.1842235730793,0.4984627209838586,0.13443006540917718,6,96.22322799212152,0.02229275506707497,0.2903847316754494,1.0,True, -19,24,7.752290899896264,99.91483670708607,0.5732565579014716,0.1300803661721533,6,45.37964984018865,0.07078749161909308,0.6582469262123747,1.0,False,forward_reverse_rotation -20,21,2.057726146362386,50.884840041624386,0.7808828984790405,0.11119787612354914,6,10.584324886965474,0.0031476308503252674,0.022487168529706673,1.0,True, -20,22,4.388457127616061,94.54259968980386,0.6557604850934815,0.11898674179731801,6,16.883756700029306,0.008500396323601164,0.06463449106814506,1.0,True, -20,23,8.256548639868363,126.4903843444735,0.5833545108005083,0.12863144503040289,6,48.7242741462686,0.013890482176493085,0.14514813799569015,1.0,True, -20,24,5.797339988732605,169.75977121046614,0.6348521385962685,0.11831053318180502,6,31.671029215629257,0.00725649124030166,0.27346756317921195,1.0,True, -20,25,3.9584300095978864,99.81821396908215,0.7094296865164296,0.11461231093244224,6,16.207076145397426,0.005999722474434507,0.07369423294061743,1.0,True, -21,22,2.665930009787955,43.65775964817948,0.7387220368310469,0.11520069835112393,6,16.025252253059314,0.0021484382611444506,0.09312757978022868,1.0,True, -21,23,6.670349114267683,75.60554430284907,0.6238657551274084,0.11987801174807478,6,32.271874238810035,0.007927242611182222,0.08795608522524892,1.0,True, -21,24,4.0761181240750135,118.87493116884215,0.6712192699279861,0.11172772070549726,6,21.556821129992922,0.04673963175312233,0.22273623714194987,1.0,True, -21,25,2.626640779558244,150.70305401070652,0.699310174919931,0.11234398811200015,6,15.335715959290205,0.018678960705618183,0.1734016933410122,1.0,True, -21,26,2.086425835169367,83.91641671720558,0.7166481550043194,0.11091971646336789,6,12.109452825928004,0.00977162867106615,0.0631934229127065,1.0,True, -22,23,4.005228418650323,31.947784654669576,0.7252984505969012,0.11644876240570266,6,17.935878140214236,0.013002087545984397,0.11470841251550605,1.0,True, -22,24,1.4231800329066895,75.21717152066267,0.7555499175440822,0.1089594430160029,6,14.427403734239578,0.0044919719825295985,0.008669004448985662,1.0,True, -22,25,0.9824487562406952,165.63918634111403,0.7088209387190134,0.11165869814478939,6,23.409617344710625,0.005265657588642687,0.10195131255569051,1.0,True, -22,26,3.0743977770984916,127.57417636538506,0.6831820474029249,0.11509847268437542,6,18.05320621935197,0.010313466929779696,0.02189018950989812,1.0,True, -22,27,3.054692363582515,96.43768805753649,0.712325317889966,0.11297739003609018,6,14.570486778570737,0.006473104665270118,0.07627008321159866,1.0,True, -23,24,2.6253440212817054,43.26938686599312,0.787546254944494,0.11112536909525574,6,13.667766137918514,0.003984385308883342,0.012875657690538275,1.0,True, -23,25,4.30404511575867,133.69140168644446,0.6839640551828883,0.11561487899989795,6,40.22316701306096,0.009663940236368565,0.2587163051792124,1.0,True, -23,26,6.580252552934289,159.52196102005493,0.6214811057570377,0.12356096223549605,6,59.18789907295204,0.03346639663911815,0.040359288659068966,1.0,True, -23,27,6.261292051742304,128.3854727122061,0.6439154109155375,0.11883308044324468,6,48.252953818047224,0.01363202571969651,0.268813724284828,1.0,True, -23,28,10.83543880539923,37.57580831192121,0.5551750380517504,0.13104613123848732,6,44.00847715074386,0.01592501575703795,0.1925228188054137,1.0,True, -24,25,2.0155105379126432,90.4220148204513,0.7610619469026548,0.10446971824743242,6,22.29894236104597,0.01721789520038266,0.09266069416139829,1.0,True, -24,26,4.344602404326578,157.20865211395216,0.6986700443318556,0.11795525471114342,6,30.354013262701024,0.0239438468814135,0.2700005297192175,1.0,True, -24,27,4.194437499675352,171.65485957819877,0.7233746521629142,0.11505806966234582,6,24.218829066684407,0.0071603040929797065,0.1144565168286882,1.0,True, -24,28,8.235813904401468,80.84519517791432,0.618522741669834,0.1218895746871147,6,34.55835443937473,0.008956300116613691,0.24319664279778394,1.0,True, -24,29,2.7255497122534083,57.0551252080454,0.7635993899339095,0.11147922533242269,6,11.572525725181164,0.02246832420061709,0.4519372330281508,1.0,True, -25,26,2.340922525153354,66.78663729350096,0.8176906646563639,0.1076748622762494,6,10.194320056407282,0.011727583881002021,0.04299213457608308,1.0,True, -25,27,2.187150933555911,97.92312560134954,0.8508155583437892,0.10177690901936605,6,9.447407214356089,0.004921098494284399,0.04722324529000337,1.0,True, -25,28,6.688406442287195,171.26720999836604,0.6552720874701521,0.1158307449607044,6,16.856702471098828,0.010027166778796438,0.069841684352646,1.0,True, -25,29,1.411474020521721,147.47714002849685,0.7434442763489663,0.11227320270489505,6,19.207346965238134,0.005744598995027529,0.30413185830684,1.0,True, -25,30,0.5324917816481396,118.09183853064393,0.7986111111111112,0.1061010900656728,6,14.995080416656407,0.004651476537899485,0.06337779258524685,1.0,True, -26,27,0.6349061963265976,31.136488307848563,0.8835952231301069,0.10164781558403184,6,8.741658683232068,0.0010243697887392141,0.04630474119881922,1.0,True, -26,28,5.008419104260455,121.94615270813352,0.7013346764039284,0.1156303654422143,6,10.39669408260953,0.016692399239017493,0.1408617368634082,1.0,True, -26,29,2.224643201350574,145.73622267800252,0.7255273462170014,0.11343814488049828,6,14.171918272295303,0.0030631045126193056,0.10499072900350268,1.0,True, -26,30,2.6736935848107626,175.1215241758588,0.7273877292852625,0.11178149175643984,6,20.18904245623208,0.002906139936114469,0.06343916895540856,1.0,True, -26,31,6.867005915953627,145.82839665297058,0.6099962135554714,0.12348129729633385,6,43.35600938855713,0.011230201352754812,0.02547666380871279,1.0,True, -27,28,5.622863551235285,90.80966440028486,0.7116811266188859,0.11387091842867321,6,10.816842555490693,0.011430300098438593,0.17858658887118406,1.0,True, -27,29,2.458639091699311,114.59973437015381,0.7588294651866802,0.10898351788466304,6,11.452504275483305,0.002552411031283606,0.096053889700167,1.0,True, -27,30,2.614522132166758,143.98503586800658,0.7699595755432036,0.10809432324457112,6,19.384788093934308,0.006419845852952349,0.09683669503892821,1.0,True, -27,31,6.500901961576647,114.69190834512194,0.6407864885303756,0.12195597170279295,6,45.71099685307573,0.03203829198983217,0.21314212616538905,1.0,True, -27,32,8.204840364723921,69.85846065460369,0.6120722798923491,0.12793570356778294,6,50.652407095458955,0.02476270066797521,0.18953242722457034,1.0,True, -28,29,5.5254251571777075,23.790069969868927,0.6751737207833228,0.11816626627973714,6,15.58130572797597,0.0036062245918322845,0.04228106700822467,1.0,True, -28,30,6.682895390289165,53.17537146772172,0.6476021763887132,0.12162303323930705,6,19.56745364015458,0.036760870155111036,0.061189777619461184,1.0,True, -28,31,11.27338119162288,23.882243944837096,0.558515338972352,0.1324943729180927,6,46.74937334475135,0.011294835537302048,0.22869636591571527,1.0,True, -28,32,12.874594603353637,20.951203745681177,0.5356867779204108,0.13793317141107478,6,47.36276875018484,0.009260784922164039,0.4736145985672847,1.0,True, -28,33,13.796424177198949,59.567633422321585,0.49968659897204465,0.13776776698165452,6,59.65569689133837,0.03480709552965627,0.1328751318540718,1.0,True, -29,30,1.1998189814142899,29.3853014978528,0.8126428027418127,0.11465616151168853,6,9.73882704495904,0.059123063905753705,0.35885997079417975,1.0,True, -29,31,5.755712819539279,0.09217397496817598,0.7178318135764944,0.11831514282300001,6,19.572443598172608,0.03055388488044922,0.16788276176822323,1.0,True, -29,32,7.3497160995478215,44.7412737155501,0.6866709594333548,0.12344589693451308,6,19.69654687402097,0.01847461637742171,0.10764991453418553,1.0,True, -29,33,8.359102419083325,83.35770339219052,0.6151911468812877,0.12607024585552623,6,19.321252328369155,0.005640558537625966,0.060018922799470055,1.0,True, -29,34,8.008340805017072,133.40261903862776,0.6489454636216149,0.1229782406905996,6,19.361211916752247,0.024951598645873194,0.20519725330906424,1.0,True, -30,31,4.592128513798009,29.29312752288462,0.76103500761035,0.11418966560335815,6,16.756236396505788,0.010805499433410783,0.0764328342532002,1.0,True, -30,32,6.2188831730504885,74.12657521340287,0.7051463949438926,0.11749249261595905,6,20.554466965332146,0.009422682577629085,0.037900377279079585,1.0,True, -30,33,7.344850966128434,112.7430048900433,0.6064231738035264,0.12368925274094972,6,20.291143104650924,0.0147669225762263,0.09037435316445036,1.0,True, -30,34,7.0347870411064095,162.78792053648075,0.6427946506686664,0.12352381867411776,6,21.47516866844496,3.1821548176867474,2.4099911828321603,1.0,False,forward_reverse_translation;forward_reverse_rotation -30,35,9.281470813161304,166.02816439171798,0.690784364483562,0.12252550482763978,6,16.634587270964886,0.009824737708452339,0.14818916841264132,1.0,True, -31,32,1.7043840283934533,44.83344769051828,0.7959078625659504,0.10965414855273443,6,12.882067962817517,0.009608345699366565,0.04073745185785107,1.0,True, -31,33,3.3472002644811774,83.44987736715868,0.636089469716009,0.11810494837446742,6,13.701242758091343,0.01055590691460776,0.06271370554561609,1.0,True, -31,34,3.311630046755356,133.49479301359594,0.6599326599326599,0.11513164519765848,6,15.199690471396346,0.002580333972310516,0.03476275200242535,1.0,True, -31,35,4.805055361756335,164.67870808539848,0.7747933884297521,0.1099315236542533,6,13.983106845566315,0.002969158365974405,0.02482993261597952,1.0,True, -31,36,5.921091773191984,169.88970913698103,0.79326799071447,0.11165900641583826,6,12.181844458808802,0.004151989866605975,0.032942374858786365,1.0,True, -32,33,1.9394369188755196,38.61642967664041,0.7479238533282229,0.1140254726045761,6,12.862133545437658,0.005854383016193307,0.042356141718508426,1.0,True, -32,34,2.1435446082722334,88.6613453230776,0.7426470588235294,0.11481351455228676,6,15.077486603426832,0.0025843844761028077,0.009064526838353553,1.0,True, -32,35,3.1027737257249126,119.84526039487966,0.8209641402863523,0.10635864973089924,6,10.914008667831691,0.004447738370013908,0.11616784364821804,1.0,True, -32,36,4.235311686227635,145.27684317250132,0.7613800341073068,0.10898930843612145,6,12.22686011069426,0.008302372052489307,0.047221847858387886,1.0,True, -32,37,3.1931475050378357,118.78221388859481,0.6919923126201153,0.11497666348297753,6,16.91846428853567,0.00567166990415677,0.10190182649448634,1.0,True, -33,34,0.5704890065278277,50.0449156464372,0.8247678018575851,0.10774292174748101,6,13.307399451848953,0.005218203824516851,0.054034410494683056,1.0,True, -33,35,2.3843314966611664,81.22883071823928,0.7097435897435898,0.11216257584808116,6,12.920219167499932,0.0055472051152683725,0.06161504272529624,1.0,True, -33,36,3.5605240220038255,106.66041349586102,0.62202304737516,0.11282494351568334,6,18.491230751066993,0.009207361872581905,0.07430583689659953,1.0,True, -33,37,4.013080941901569,80.16578421195443,0.6328828828828829,0.12540757119118434,6,17.018187124475837,0.0036940550280262596,0.12927083795080543,1.0,True, -34,35,2.9403442697824866,31.183915071802076,0.7146673451214858,0.11428688542425412,6,13.705016766266674,0.013436446539858737,0.05510481554154184,1.0,True, -34,36,4.102710388907318,56.61549784942384,0.6465506288908652,0.11729490897001751,6,19.754334744118587,0.086056763787067,1.0836879727751445,1.0,False,forward_reverse_translation;forward_reverse_rotation -34,37,3.6865711881345757,30.12086856551724,0.6899292189246243,0.11937420197560855,6,16.808577408839643,0.005083360744530967,0.10024940937419655,1.0,True, -35,36,1.2045561534352058,25.431582777621774,0.8242496050552922,0.10907898456971946,6,9.660062538057792,0.0026096461304541156,0.07595057929078583,1.0,True, -35,37,6.084062615492111,1.063046506284832,0.6924659295448702,0.12103303062396852,6,14.36240888115935,0.005914867863779407,0.06573359298031699,1.0,True, -36,37,7.2781244258509386,26.494629283906598,0.6402157164869029,0.12413886977390769,6,20.08544982146282,0.008397869289519334,0.08479281990151419,1.0,True, diff --git a/results/01_previous_two_batches/small_gicp/B_batch2_quality.json b/results/01_previous_two_batches/small_gicp/B_batch2_quality.json deleted file mode 100644 index b112a9d..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch2_quality.json +++ /dev/null @@ -1,22523 +0,0 @@ -{ - "schema_version": 2, - "backend": "small_gicp", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 38, - "candidate_pairs": 175, - "accepted_pairs": 154, - "parameters": { - "command": "pairs", - "backend": "small_gicp", - "frames": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_data1_20260720\\prepared\\frames_all", - "body": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\outputs\\calibration_data1_20260720\\prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch2_estimation.npz", - "quality_json": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch2_quality.json", - "quality_csv": "C:\\Users\\admin\\Documents\\Codex\\2026-07-15\\wo\\rigorous_build\\results\\small_gicp\\B_batch2_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 25, - "min_gap": 1, - "max_gap": 5, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 60, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 2, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 252, - "translation_rms_m": 0.06356464456110195, - "translation_p95_m": 0.12253135158224471, - "rotation_rms_deg": 0.7286536542725655, - "rotation_p95_deg": 1.4911215410143956 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279429.4466305, - "frame_counter_i": 190, - "frame_counter_j": 1125, - "rtk_translation_m": 0.503306788400079, - "rtk_rotation_deg": 13.198324485965863, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9732256594175284, - 0.2298393437518817, - 0.002385773464110897, - -0.5085216582325164 - ], - [ - -0.22984329308833232, - 0.973226438955539, - 0.0015359492935228738, - -0.43801336988634615 - ], - [ - -0.0019688762349718025, - -0.002043179293574694, - 0.9999959744642708, - -0.024755598336912075 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8566, - "backend_objective": 800.1659387525409, - "backend_elapsed_sec": 0.10616989999834914, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 3428, - "objective": 698.6300560684315 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6105, - "objective": 591.0170449604074 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8566, - "objective": 800.1659387525409 - } - ], - "heldout_symmetric": { - "evaluated": 8264, - "inliers": 6720, - "inlier_ratio": 0.8131655372700871, - "inlier_rmse_m": 0.09008834340898543, - "median_m": 0.07150272364081242, - "p90_m": 0.7643873169289985, - "p95_m": 1.9780435889281305 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 127127.10711156312, - 144192.6425942114, - 482295.5871918031, - 590428.0484319527, - 878779.0524505649, - 1452972.521413469 - ], - "effective_rank": 6, - "scaled_condition_number": 11.429289586039127, - "weakest_scaled_direction": [ - -0.19634401538370133, - -0.14111436174942188, - -0.1380782778733392, - 0.08534798273642365, - -0.9400496425004065, - -0.17746139069744757 - ] - }, - "forward_reverse": { - "translation_m": 0.0005504552049968047, - "rotation_deg": 0.0032916777115618487 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0927876733745939e-15, - "rotation_deg": 5.523027526173787e-15 - }, - { - "translation_m": 7.208522290024695e-16, - "rotation_deg": 1.67420866733509e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279517.5427606, - "frame_counter_i": 190, - "frame_counter_j": 2006, - "rtk_translation_m": 1.1601020961002007, - "rtk_rotation_deg": 26.306295080591493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8991999191454997, - 0.43749726711979775, - 0.005970483350278111, - -1.2947436424060323 - ], - [ - -0.43731840170963265, - 0.8990972068229134, - -0.019412063501042746, - -0.47848585880660605 - ], - [ - -0.013860769634479925, - 0.014844323694407325, - 0.9997937412882696, - -0.07678373134058225 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8207, - "backend_objective": 2066.8679439242123, - "backend_elapsed_sec": 0.07528679999813903, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3563, - "objective": 606.1669939786403 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6206, - "objective": 929.4738203786825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8207, - "objective": 2066.8679439242123 - } - ], - "heldout_symmetric": { - "evaluated": 7897, - "inliers": 6450, - "inlier_ratio": 0.8167658604533367, - "inlier_rmse_m": 0.09980570916927256, - "median_m": 0.0849131852949364, - "p90_m": 0.4706026789170791, - "p95_m": 0.8232606542322466 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 122216.78268988681, - 141833.60418954302, - 333958.07258977805, - 595525.0783681868, - 871578.8106490916, - 1345349.0088035332 - ], - "effective_rank": 6, - "scaled_condition_number": 11.00789089021616, - "weakest_scaled_direction": [ - 0.24587060688981208, - 0.24939706911878312, - 0.11994305554925777, - -0.31575142502115205, - 0.8421061088763301, - 0.23263866617220508 - ] - }, - "forward_reverse": { - "translation_m": 0.00205395151868756, - "rotation_deg": 0.012799633971915293 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2918275027307398e-15, - "rotation_deg": 8.776105392667376e-15 - }, - { - "translation_m": 1.784146017590271e-15, - "rotation_deg": 1.2831929167843777e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 190, - "frame_counter_j": 2883, - "rtk_translation_m": 1.1328421148283978, - "rtk_rotation_deg": 41.74134818989305, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7507835450319097, - 0.6605182914902072, - 0.006297230834027551, - -1.460141234276999 - ], - [ - -0.660269990415803, - 0.7507098178407177, - -0.021870280150761076, - -0.6505379186527889 - ], - [ - -0.019173113091906654, - 0.012261973919999931, - 0.999740984320414, - -0.05787471599177796 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8532, - "backend_objective": 2130.926933392321, - "backend_elapsed_sec": 0.08671429999958491, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3808, - "objective": 599.7791707863356 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 1, - "num_inliers": 6517, - "objective": 960.4645701008354 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8532, - "objective": 2130.926933392321 - } - ], - "heldout_symmetric": { - "evaluated": 8061, - "inliers": 6565, - "inlier_ratio": 0.81441508497705, - "inlier_rmse_m": 0.10115686777955255, - "median_m": 0.08458581147138328, - "p90_m": 0.4660560635311788, - "p95_m": 0.8713542138173543 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 85008.94227532795, - 134972.94040412531, - 334993.25799912383, - 571937.3703236526, - 898302.400939096, - 1176313.7618310205 - ], - "effective_rank": 6, - "scaled_condition_number": 13.837529680361882, - "weakest_scaled_direction": [ - -0.0932947986663009, - -0.6384188712161041, - -0.06353273820808344, - 0.12222938228953248, - 0.033772758630078246, - -0.7507332385557387 - ] - }, - "forward_reverse": { - "translation_m": 0.01247476852224996, - "rotation_deg": 0.1726729736128094 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1805095966397748e-15, - "rotation_deg": 1.1405728698500914e-14 - }, - { - "translation_m": 1.4634981008368425e-15, - "rotation_deg": 1.3799950714150735e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 4, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 190, - "frame_counter_j": 3843, - "rtk_translation_m": 1.0129799192122786, - "rtk_rotation_deg": 70.92934830291522, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3237149715595392, - 0.9461239052668428, - 0.007627127298400648, - -1.6483199176021062 - ], - [ - -0.9458072202066334, - 0.3238040257544178, - -0.024487856382962664, - -0.6173217934817673 - ], - [ - -0.025638240836825747, - 0.000713293664302386, - 0.9996710317994324, - -0.053929018244232775 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 16, - "backend_num_inliers": 8011, - "backend_objective": 2108.7675231132316, - "backend_elapsed_sec": 0.12251970000215806, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3645, - "objective": 802.61361107168 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6175, - "objective": 962.3133639178966 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 16, - "num_inliers": 8011, - "objective": 2108.7675231132316 - } - ], - "heldout_symmetric": { - "evaluated": 8150, - "inliers": 6326, - "inlier_ratio": 0.7761963190184049, - "inlier_rmse_m": 0.10269905695661055, - "median_m": 0.092787645701402, - "p90_m": 0.6428594177123093, - "p95_m": 1.399431328691987 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 88390.07116347234, - 117640.6772263984, - 311451.6466644674, - 510595.6465231369, - 780502.0587304652, - 1139198.9328779848 - ], - "effective_rank": 6, - "scaled_condition_number": 12.888313335228592, - "weakest_scaled_direction": [ - -0.15099919243123003, - 0.6483079426744522, - 0.08404109807821823, - -0.19786568649492553, - -0.020788101540660568, - 0.7143179783026392 - ] - }, - "forward_reverse": { - "translation_m": 0.019300920937430674, - "rotation_deg": 0.12217052794626229 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.866392382354308e-16, - "rotation_deg": 6.538712548310644e-15 - }, - { - "translation_m": 1.2536375005832404e-15, - "rotation_deg": 5.409527190998637e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 5, - "lidar_time_i": 1784279335.9505181, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 190, - "frame_counter_j": 5003, - "rtk_translation_m": 0.9014321094792815, - "rtk_rotation_deg": 89.27285808969826, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.012140229839875234, - 0.9999219044592973, - 0.0029664460097021165, - -1.8770214018326028 - ], - [ - -0.9992401986919791, - 0.012241726835893236, - -0.0370022356363908, - -0.6810015743053482 - ], - [ - -0.037035660348515714, - -0.0025149764549287587, - 0.9993107798657941, - 0.05379271077638566 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7783, - "backend_objective": 2160.620556866371, - "backend_elapsed_sec": 0.08606969999527792, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3511, - "objective": 710.2828254834725 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6002, - "objective": 780.4021125102065 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7783, - "objective": 2160.620556866371 - } - ], - "heldout_symmetric": { - "evaluated": 8071, - "inliers": 6243, - "inlier_ratio": 0.7735100978813034, - "inlier_rmse_m": 0.10986502690369805, - "median_m": 0.10426975632953092, - "p90_m": 0.6235615795371964, - "p95_m": 1.091614253556231 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38178.17581558952, - 104571.80383915416, - 176082.99599709187, - 472078.39547131513, - 734448.3114064794, - 951369.7244056237 - ], - "effective_rank": 6, - "scaled_condition_number": 24.919203290408266, - "weakest_scaled_direction": [ - -0.47205032676462316, - 0.4009233405946271, - 0.036378319707655996, - -0.005183773764305123, - -0.10620581347740907, - 0.7770450665799679 - ] - }, - "forward_reverse": { - "translation_m": 0.0278108340699398, - "rotation_deg": 0.2717481445912482 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.972820174300706e-16, - "rotation_deg": 1.7971802608021663e-15 - }, - { - "translation_m": 7.663002283985489e-16, - "rotation_deg": 3.913705699227609e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279517.5427606, - "frame_counter_i": 1125, - "frame_counter_j": 2006, - "rtk_translation_m": 0.6927979865343085, - "rtk_rotation_deg": 13.107970594625625, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9753042373167554, - 0.2208460546918724, - 0.002943603067090265, - -0.7491357964104429 - ], - [ - -0.22085053512229444, - 0.975306809757105, - 0.0012915020764511498, - -0.24571341143089132 - ], - [ - -0.0025856929783444394, - -0.001909703760220707, - 0.9999948335983389, - -0.044123084484436 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8024, - "backend_objective": 950.6058121200639, - "backend_elapsed_sec": 0.06771630000002915, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 3403, - "objective": 425.51183210243687 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5807, - "objective": 534.4615858588727 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8024, - "objective": 950.6058121200639 - } - ], - "heldout_symmetric": { - "evaluated": 7815, - "inliers": 6135, - "inlier_ratio": 0.7850287907869482, - "inlier_rmse_m": 0.08649388452503427, - "median_m": 0.07459999812033362, - "p90_m": 0.7976262020686651, - "p95_m": 1.8764598290016992 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 136611.3309743703, - 208629.76645261946, - 429218.3880497316, - 622551.8685533825, - 979479.1450590679, - 1606202.250175659 - ], - "effective_rank": 6, - "scaled_condition_number": 11.757459931907107, - "weakest_scaled_direction": [ - -0.15209132713786247, - -0.12248432812431614, - -0.1321063188605056, - 0.28258633424506685, - -0.9233316441046394, - -0.10962379661124555 - ] - }, - "forward_reverse": { - "translation_m": 0.001960394451155616, - "rotation_deg": 0.002128143929965857 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.548010594714626e-15, - "rotation_deg": 6.05377305178897e-15 - }, - { - "translation_m": 8.900196549101993e-16, - "rotation_deg": 9.23921728892002e-16 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 1125, - "frame_counter_j": 2883, - "rtk_translation_m": 0.7002295454253883, - "rtk_rotation_deg": 28.543023703927183, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.881547379653831, - 0.47207796552633674, - 0.004075768636618514, - -0.8711444583150696 - ], - [ - -0.4720874363232396, - 0.8815500038044718, - 0.0017444936480975643, - -0.4444293763355881 - ], - [ - -0.0027694568448496802, - -0.0034619729710110556, - 0.9999901723776752, - -0.0350837548135943 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8378, - "backend_objective": 1518.577815920697, - "backend_elapsed_sec": 0.09606340000027558, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3653, - "objective": 555.3094324458108 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6202, - "objective": 992.7268828320242 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8378, - "objective": 1518.577815920697 - } - ], - "heldout_symmetric": { - "evaluated": 7979, - "inliers": 6305, - "inlier_ratio": 0.7901992730918661, - "inlier_rmse_m": 0.09109387779670658, - "median_m": 0.07883398513573667, - "p90_m": 0.7975185019481512, - "p95_m": 1.9234942357114353 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 115707.41981086135, - 140383.5774464469, - 378039.2505205002, - 592966.3942336395, - 892085.2446302066, - 1396129.2433876668 - ], - "effective_rank": 6, - "scaled_condition_number": 12.066030386554463, - "weakest_scaled_direction": [ - 0.19425838910289805, - 0.6590724813333837, - 0.08479105358014388, - -0.21535038410370463, - 0.12192394047794353, - 0.6778321212879267 - ] - }, - "forward_reverse": { - "translation_m": 0.004906057223105903, - "rotation_deg": 0.018773640398341965 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.578912943764841e-15, - "rotation_deg": 2.190982497334873e-14 - }, - { - "translation_m": 2.557516652023314e-15, - "rotation_deg": 1.0846416904469455e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 1125, - "frame_counter_j": 3843, - "rtk_translation_m": 0.8045641659338967, - "rtk_rotation_deg": 57.731023816949346, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5323491136448291, - 0.846459277713314, - 0.010540985467243778, - -1.063409138588704 - ], - [ - -0.8462414853710563, - 0.5324518141189986, - -0.01924614450676706, - -0.43926523768638365 - ], - [ - -0.02190364441260007, - 0.0013254487701826294, - 0.9997592077830563, - -0.045035546834941785 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7667, - "backend_objective": 1966.7932874558626, - "backend_elapsed_sec": 0.09439659999770811, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3500, - "objective": 603.5430385386157 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5909, - "objective": 963.9412291591607 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7667, - "objective": 1966.7932874558626 - } - ], - "heldout_symmetric": { - "evaluated": 8068, - "inliers": 6002, - "inlier_ratio": 0.7439266236985622, - "inlier_rmse_m": 0.09680131928922782, - "median_m": 0.08945864212194773, - "p90_m": 1.125966460765389, - "p95_m": 1.8098815635700962 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 92960.33375739795, - 129310.85336628548, - 239700.5466632511, - 450093.4039979895, - 746797.7110681742, - 1195525.3395512789 - ], - "effective_rank": 6, - "scaled_condition_number": 12.860596463339792, - "weakest_scaled_direction": [ - -0.028059693390673948, - 0.7920632148123288, - 0.1041214336872416, - -0.25476403527265873, - 0.03507260922265212, - 0.5430215859510557 - ] - }, - "forward_reverse": { - "translation_m": 0.020081946886066578, - "rotation_deg": 1.2340284819813434 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.266153263119412e-15, - "rotation_deg": 9.902968746715307e-15 - }, - { - "translation_m": 1.8463326216622014e-15, - "rotation_deg": 3.0684007067329122e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 1, - "j": 5, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 1125, - "frame_counter_j": 5003, - "rtk_translation_m": 0.7829726518389362, - "rtk_rotation_deg": 76.07453360373235, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.24070349668981553, - 0.9705207499445719, - 0.012300431225068612, - -1.2623817879107437 - ], - [ - -0.9702779111467469, - 0.24093041665123108, - -0.02265633405850208, - -0.5498501275160544 - ], - [ - -0.024951990341497754, - -0.006481377885209785, - 0.9996676397276786, - -0.036381676264847396 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 15, - "backend_num_inliers": 7306, - "backend_objective": 2281.791358890212, - "backend_elapsed_sec": 0.11966459999530343, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3335, - "objective": 713.4478599130833 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5675, - "objective": 1012.4245511285837 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 15, - "num_inliers": 7306, - "objective": 2281.791358890212 - } - ], - "heldout_symmetric": { - "evaluated": 7989, - "inliers": 5843, - "inlier_ratio": 0.7313806483915384, - "inlier_rmse_m": 0.10148815288043825, - "median_m": 0.09629022829827855, - "p90_m": 1.011882598262486, - "p95_m": 1.9797034236741615 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 69421.94750535664, - 121783.02166618757, - 274279.64644914947, - 375948.8952108587, - 640075.1251452807, - 887385.3197964014 - ], - "effective_rank": 6, - "scaled_condition_number": 12.782489568272775, - "weakest_scaled_direction": [ - -0.3966805371957081, - 0.5458924600085838, - 0.057701236580493774, - -0.06108686034890065, - -0.10516780921378814, - 0.7256201955643661 - ] - }, - "forward_reverse": { - "translation_m": 0.016729134900242502, - "rotation_deg": 0.06734086907642674 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3011304966701034e-15, - "rotation_deg": 6.253717412105089e-15 - }, - { - "translation_m": 2.8313748239171495e-16, - "rotation_deg": 2.7153132379059204e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 6, - "lidar_time_i": 1784279429.4466305, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 1125, - "frame_counter_j": 1175, - "rtk_translation_m": 0.7843480712672012, - "rtk_rotation_deg": 108.63393511864574, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3207773069269725, - 0.9469621104343048, - -0.019096616519349692, - -1.1183309436712972 - ], - [ - -0.9456473656271649, - -0.32133873663149887, - -0.049924705532190555, - -1.7975182814012605 - ], - [ - -0.05341328713983838, - 0.002043952514177049, - 0.998570399628908, - -0.001264041666279185 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 5685, - "backend_objective": 991.3300870242351, - "backend_elapsed_sec": 0.09591509999881964, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 2891, - "objective": 702.1681036620406 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4488, - "objective": 588.8036733602504 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 5685, - "objective": 991.3300870242351 - } - ], - "heldout_symmetric": { - "evaluated": 7965, - "inliers": 4950, - "inlier_ratio": 0.6214689265536724, - "inlier_rmse_m": 0.10742176387842234, - "median_m": 0.14398824110256872, - "p90_m": 1.5991467788154858, - "p95_m": 2.1879648868876447 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21889.29440411709, - 77436.17933876459, - 145319.2784209207, - 341949.9533876121, - 369692.1747074788, - 577673.6879648389 - ], - "effective_rank": 6, - "scaled_condition_number": 26.39069479810122, - "weakest_scaled_direction": [ - -0.6590413750352909, - 0.014950130341998102, - 0.01668842756491527, - 0.05045404479557536, - -0.08896804820174205, - 0.7447828755702562 - ] - }, - "forward_reverse": { - "translation_m": 0.0027238824581310127, - "rotation_deg": 0.04004688680398286 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.972820174300706e-16, - "rotation_deg": 5.1160880123469024e-15 - }, - { - "translation_m": 7.217783939387125e-16, - "rotation_deg": 6.722893561527567e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279605.2394407, - "frame_counter_i": 2006, - "frame_counter_j": 2883, - "rtk_translation_m": 0.13949776780243606, - "rtk_rotation_deg": 15.435053109301553, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9640762793185083, - 0.2656250519169471, - 0.0005093618563565898, - -0.07193547920760454 - ], - [ - -0.26562535638342616, - 0.9640760958074671, - 0.0006719663747859206, - -0.2255792998097866 - ], - [ - -0.0003125724866405519, - -0.0007831262670535983, - 0.9999996445057819, - -0.001459604973264177 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 1, - "backend_num_inliers": 9532, - "backend_objective": 334.620458431214, - "backend_elapsed_sec": 0.060703200004354585, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4068, - "objective": 533.9651743310599 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 1, - "num_inliers": 6927, - "objective": 404.1061150540427 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 1, - "num_inliers": 9532, - "objective": 334.620458431214 - } - ], - "heldout_symmetric": { - "evaluated": 7612, - "inliers": 6985, - "inlier_ratio": 0.9176300578034682, - "inlier_rmse_m": 0.07082931569628453, - "median_m": 0.0392236696544116, - "p90_m": 0.2044701574980096, - "p95_m": 0.40529659858833095 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 171317.94425119928, - 208557.57463665362, - 554739.5493603422, - 852666.2284170219, - 1073193.4473534105, - 2011330.0948243802 - ], - "effective_rank": 6, - "scaled_condition_number": 11.740335220665598, - "weakest_scaled_direction": [ - 0.08020096373145429, - 0.15440249004806095, - 0.11733206131217734, - -0.5410822831394393, - 0.8022198601392845, - 0.14012181394221998 - ] - }, - "forward_reverse": { - "translation_m": 0.0016419682635548487, - "rotation_deg": 0.0015051284247814798 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.310097920393626e-15, - "rotation_deg": 2.3342153879162976e-14 - }, - { - "translation_m": 1.1966589035335742e-15, - "rotation_deg": 3.844100615943765e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 2006, - "frame_counter_j": 3843, - "rtk_translation_m": 0.6701726006967371, - "rtk_rotation_deg": 44.62305322232371, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7048832942591895, - 0.7093220814828741, - 0.0013138474474602602, - -0.2527241215477539 - ], - [ - -0.7093232594931878, - 0.7048826590408818, - 0.0009749489298855402, - -0.27696731318432055 - ], - [ - -0.00023455547805395887, - -0.001619167767341502, - 0.999998661638839, - -0.01017446001112357 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8664, - "backend_objective": 551.146071870455, - "backend_elapsed_sec": 0.0811598000000231, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3877, - "objective": 1366.7313686720768 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6464, - "objective": 605.8598533267452 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8664, - "objective": 551.146071870455 - } - ], - "heldout_symmetric": { - "evaluated": 7701, - "inliers": 6473, - "inlier_ratio": 0.840540189585768, - "inlier_rmse_m": 0.08212714345330237, - "median_m": 0.05789008533433127, - "p90_m": 0.456475302539791, - "p95_m": 0.9833165142015567 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 135625.31762428777, - 162510.87772821824, - 413260.11396482604, - 644273.7076506147, - 920028.3362660705, - 1751911.9509995335 - ], - "effective_rank": 6, - "scaled_condition_number": 12.917292889611646, - "weakest_scaled_direction": [ - 0.015105072509023772, - 0.31121689742039627, - 0.13212580856615153, - -0.8274532308327696, - 0.39561351139545275, - 0.2104037800065182 - ] - }, - "forward_reverse": { - "translation_m": 0.0015059170263523442, - "rotation_deg": 0.004861145455894842 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6392806421131483e-15, - "rotation_deg": 1.1610282440903066e-14 - }, - { - "translation_m": 1.6088398260303535e-15, - "rotation_deg": 8.448115938895552e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 2006, - "frame_counter_j": 5003, - "rtk_translation_m": 0.8004226998626774, - "rtk_rotation_deg": 62.96656300910673, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4472602661693201, - 0.8944019725064142, - 0.0018346342375135294, - -0.42079565404901803 - ], - [ - -0.8944031573465188, - 0.4472564163313923, - 0.0021656821042411287, - -0.43112120071377696 - ], - [ - 0.0011164384115059415, - -0.002609526208989154, - 0.999995971961006, - -0.021208538992309414 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 8224, - "backend_objective": 973.7248476968485, - "backend_elapsed_sec": 0.18923859999631532, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3694, - "objective": 719.7869373009748 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6275, - "objective": 1511.8846293724382 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 8224, - "objective": 973.7248476968485 - } - ], - "heldout_symmetric": { - "evaluated": 7622, - "inliers": 6327, - "inlier_ratio": 0.8300970873786407, - "inlier_rmse_m": 0.0931389934573794, - "median_m": 0.0712921466628325, - "p90_m": 0.4794780723326294, - "p95_m": 0.8394619293753688 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 89355.48633712047, - 130082.35744833632, - 337784.5941874275, - 556361.7846189302, - 838195.1349037761, - 1407222.19854962 - ], - "effective_rank": 6, - "scaled_condition_number": 15.74858194202481, - "weakest_scaled_direction": [ - 0.3977725954006704, - -0.47098084593865785, - -0.06691961147751312, - 0.11204472333049269, - 0.09665282514658931, - -0.7704414202726875 - ] - }, - "forward_reverse": { - "translation_m": 0.002555949510569182, - "rotation_deg": 0.008486377461290648 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.487709209519727e-15, - "rotation_deg": 1.1962563139299163e-14 - }, - { - "translation_m": 5.012342323564822e-15, - "rotation_deg": 3.349708966143404e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 6, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 2006, - "frame_counter_j": 1175, - "rtk_translation_m": 1.3845111356101025, - "rtk_rotation_deg": 95.5259645240201, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.10404256909103815, - 0.9945485923216271, - -0.006945597742925645, - -0.013979498473940323 - ], - [ - -0.9932538195997412, - -0.10426159591671733, - -0.0507579497953143, - -1.588019923726897 - ], - [ - -0.05120540662333461, - 0.0016177539890657995, - 0.9986868323977091, - -0.01790833071120444 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5822, - "backend_objective": 1352.8338210257245, - "backend_elapsed_sec": 0.07748949999950128, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3066, - "objective": 649.461583341915 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 4737, - "objective": 541.581048509136 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5822, - "objective": 1352.8338210257245 - } - ], - "heldout_symmetric": { - "evaluated": 7598, - "inliers": 4935, - "inlier_ratio": 0.6495130297446696, - "inlier_rmse_m": 0.10354826871538153, - "median_m": 0.12912553648470815, - "p90_m": 1.4043193369485218, - "p95_m": 1.8158576660833958 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42899.99809040511, - 86289.52356577072, - 207651.46161091395, - 403588.9447170074, - 440068.5354316061, - 654780.6424403922 - ], - "effective_rank": 6, - "scaled_condition_number": 15.262952717632835, - "weakest_scaled_direction": [ - 0.6037873165423945, - 0.04208797455158253, - -0.01508083000414903, - -0.014239548876784143, - 0.1003363803283117, - -0.7894123721968536 - ] - }, - "forward_reverse": { - "translation_m": 0.008359384079660144, - "rotation_deg": 0.07441619593698878 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6453228041423052e-15, - "rotation_deg": 2.913053046312571e-15 - }, - { - "translation_m": 1.0345236923802117e-15, - "rotation_deg": 3.777125047300642e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 7, - "lidar_time_i": 1784279517.5427606, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 2006, - "frame_counter_j": 2514, - "rtk_translation_m": 2.161304865409727, - "rtk_rotation_deg": 119.81081101983789, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5083278870531132, - 0.8608449849313177, - -0.02342373076001189, - -0.13659059256963346 - ], - [ - -0.8601730566179443, - -0.508859559572662, - -0.03412127342376529, - 0.09852740192896535 - ], - [ - -0.04129251642440702, - 0.002803667262170939, - 0.9991431666869486, - 0.02125259569168905 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8182, - "backend_objective": 1821.551527909283, - "backend_elapsed_sec": 0.19959789999848, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3747, - "objective": 753.8402034864624 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6359, - "objective": 726.0091665297025 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8182, - "objective": 1821.551527909283 - } - ], - "heldout_symmetric": { - "evaluated": 7497, - "inliers": 6105, - "inlier_ratio": 0.8143257302921169, - "inlier_rmse_m": 0.09968516416989152, - "median_m": 0.07875044422978825, - "p90_m": 0.5777439408614219, - "p95_m": 1.249053296621173 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34087.71268218264, - 146190.9623505872, - 211513.42809979687, - 637392.8203465935, - 881345.906925634, - 1041052.9573337135 - ], - "effective_rank": 6, - "scaled_condition_number": 30.540416925007207, - "weakest_scaled_direction": [ - -0.48114227307438556, - -0.316977184241734, - 0.01218553240806845, - 0.06665237511260821, - -0.06524625818134831, - 0.8118986865466091 - ] - }, - "forward_reverse": { - "translation_m": 0.013121403719342412, - "rotation_deg": 0.05039604031914888 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.2356050802197154e-15, - "rotation_deg": 8.774890219883372e-15 - }, - { - "translation_m": 2.9810323257252123e-15, - "rotation_deg": 1.3687803109494445e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784279701.2360666, - "frame_counter_i": 2883, - "frame_counter_j": 3843, - "rtk_translation_m": 0.5366157827594368, - "rtk_rotation_deg": 29.188000113022152, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8679846571628789, - 0.49658952368904946, - 0.0012165081681853468, - -0.16162272253006085 - ], - [ - -0.4965900783388547, - 0.8679851725313911, - 0.00018536736739434647, - -0.0992369709435129 - ], - [ - -0.0009638595595663559, - -0.0007650019173759849, - 0.9999992428731214, - -0.002505129909692346 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 1, - "backend_num_inliers": 9414, - "backend_objective": 357.5654611781773, - "backend_elapsed_sec": 0.06853290000435663, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 3999, - "objective": 671.5150554607991 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6850, - "objective": 428.0068756054975 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 1, - "num_inliers": 9414, - "objective": 357.5654611781773 - } - ], - "heldout_symmetric": { - "evaluated": 7865, - "inliers": 6965, - "inlier_ratio": 0.8855689764780674, - "inlier_rmse_m": 0.07250679559229746, - "median_m": 0.04045573561450535, - "p90_m": 0.29982286365160593, - "p95_m": 0.6878363355200227 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 160314.06778957535, - 182563.3399178973, - 426228.387495322, - 790482.9365129798, - 1025327.1932662086, - 1871248.6251460423 - ], - "effective_rank": 6, - "scaled_condition_number": 11.672391892657863, - "weakest_scaled_direction": [ - -0.054478144158093725, - 0.560580460026952, - 0.12338005714738298, - -0.6287235826263396, - 0.24187001914161935, - 0.46234683045664166 - ] - }, - "forward_reverse": { - "translation_m": 0.0006574625393083392, - "rotation_deg": 0.0008548453445728261 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.58984639784215e-16, - "rotation_deg": 2.9725216646126185e-15 - }, - { - "translation_m": 2.2732166591371436e-15, - "rotation_deg": 1.955861596786982e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 2883, - "frame_counter_j": 5003, - "rtk_translation_m": 0.6760093701980526, - "rtk_rotation_deg": 47.53150989980517, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.668760921782342, - 0.7434765109975793, - 0.001227636631753575, - -0.28144262602682035 - ], - [ - -0.7434774775177969, - 0.668759380530992, - 0.0014599231410065362, - -0.29317149941822046 - ], - [ - 0.0002644250498314875, - -0.001889059731795496, - 0.9999981807647066, - -0.013410205402184691 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 9054, - "backend_objective": 639.0869598721015, - "backend_elapsed_sec": 0.07253230000060285, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3841, - "objective": 585.8842404602616 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6636, - "objective": 609.1805696439596 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 9054, - "objective": 639.0869598721015 - } - ], - "heldout_symmetric": { - "evaluated": 7786, - "inliers": 6820, - "inlier_ratio": 0.8759311584895967, - "inlier_rmse_m": 0.08543306637795112, - "median_m": 0.0575348942075644, - "p90_m": 0.31345212127260746, - "p95_m": 0.5957857806419478 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 106156.94644523914, - 149498.34933061042, - 380293.59934791055, - 636336.2730551229, - 906073.1676343402, - 1600153.0221543848 - ], - "effective_rank": 6, - "scaled_condition_number": 15.073465050917047, - "weakest_scaled_direction": [ - 0.4013540820791504, - -0.497656770378389, - -0.06150000981396836, - 0.051873102802711374, - 0.10533929003269606, - -0.7574187769450025 - ] - }, - "forward_reverse": { - "translation_m": 0.0011073394938326227, - "rotation_deg": 0.004974962253885575 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.074790117938818e-15, - "rotation_deg": 1.0596053800751206e-14 - }, - { - "translation_m": 1.2093996429075405e-15, - "rotation_deg": 9.719211903813335e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 2883, - "frame_counter_j": 1175, - "rtk_translation_m": 1.4361364806393455, - "rtk_rotation_deg": 80.09091141471853, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1636368922264762, - 0.9864205238333752, - 0.014054097720979057, - 0.418020185513016 - ], - [ - -0.9853353404175976, - 0.1641218364511524, - -0.04667215148285143, - -1.301312063126242 - ], - [ - -0.04834495244177597, - -0.0062107133399859375, - 0.9988113899096321, - -0.05643612870819132 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 18, - "backend_num_inliers": 6372, - "backend_objective": 1234.4801053146618, - "backend_elapsed_sec": 0.12717629999679048, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3169, - "objective": 612.3678327921496 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4996, - "objective": 548.909793807581 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 18, - "num_inliers": 6372, - "objective": 1234.4801053146618 - } - ], - "heldout_symmetric": { - "evaluated": 7762, - "inliers": 5269, - "inlier_ratio": 0.678819891780469, - "inlier_rmse_m": 0.10239967326707564, - "median_m": 0.11509614062000911, - "p90_m": 1.3202956512439312, - "p95_m": 1.6665946997908168 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29833.28512079834, - 92509.0262767288, - 229426.0951842202, - 416178.05519389664, - 480454.2360328732, - 690845.207022115 - ], - "effective_rank": 6, - "scaled_condition_number": 23.156860004682848, - "weakest_scaled_direction": [ - 0.6381772808584075, - 0.011587890578835913, - -0.0066903476887424426, - -0.022933269889709656, - 0.10126983657013167, - -0.7627379652076657 - ] - }, - "forward_reverse": { - "translation_m": 0.002691305620040523, - "rotation_deg": 0.027681404773136364 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1908254394821518e-15, - "rotation_deg": 1.4956429606316225e-14 - }, - { - "translation_m": 1.5981850254698907e-15, - "rotation_deg": 7.495673646058637e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 7, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 2883, - "frame_counter_j": 2514, - "rtk_translation_m": 2.1008551524156123, - "rtk_rotation_deg": 104.37575791053635, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.2621989540682933, - 0.9647744700668928, - -0.02149256598542536, - -0.14053454805490384 - ], - [ - -0.9642898662582567, - -0.2627998048653273, - -0.03288337565365705, - 0.29117477782845 - ], - [ - -0.03737328346729253, - 0.012103076877008933, - 0.9992280786752253, - -0.022920576910125137 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 8126, - "backend_objective": 1705.026279156408, - "backend_elapsed_sec": 0.11541469999792753, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3796, - "objective": 787.8368782945635 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6375, - "objective": 702.3226333607727 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 8126, - "objective": 1705.026279156408 - } - ], - "heldout_symmetric": { - "evaluated": 7661, - "inliers": 6099, - "inlier_ratio": 0.7961101683853283, - "inlier_rmse_m": 0.10180989325686585, - "median_m": 0.08672913038864698, - "p90_m": 0.6243965939502256, - "p95_m": 1.2922273690328523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35429.26074042609, - 116855.01383466086, - 158298.6213156121, - 530617.0504326754, - 808004.7942273126, - 1054251.6996354223 - ], - "effective_rank": 6, - "scaled_condition_number": 29.756525470837225, - "weakest_scaled_direction": [ - -0.5217958924874396, - -0.25740437924466847, - 0.01649084260335785, - 0.07041180104564945, - -0.05494031263530158, - 0.8082226330412785 - ] - }, - "forward_reverse": { - "translation_m": 0.023292005056525338, - "rotation_deg": 0.174639961337377 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2985081529119814e-15, - "rotation_deg": 2.0405830932194756e-14 - }, - { - "translation_m": 3.822154463220955e-15, - "rotation_deg": 2.918757742353461e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 8, - "lidar_time_i": 1784279605.2394407, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 2883, - "frame_counter_j": 3477, - "rtk_translation_m": 1.3108481779402037, - "rtk_rotation_deg": 133.20736428981294, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7173922055466644, - 0.6953845184103625, - -0.04229414824868429, - 2.1296177649839847 - ], - [ - -0.6962882744682524, - -0.713668949591621, - 0.07654586355132022, - 0.9108414494317724 - ], - [ - 0.023044788107429312, - 0.08436232538273652, - 0.9961686281935915, - -0.2981010753629422 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 23, - "backend_num_inliers": 991, - "backend_objective": 38.2380096127663, - "backend_elapsed_sec": 0.32724749999761116, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 1514, - "objective": 1888.3675051494579 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 23, - "num_inliers": 1149, - "objective": 656.7776922309768 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 23, - "num_inliers": 991, - "objective": 38.2380096127663 - } - ], - "heldout_symmetric": { - "evaluated": 7684, - "inliers": 888, - "inlier_ratio": 0.11556480999479438, - "inlier_rmse_m": 0.1433106939673773, - "median_m": 1.2905959503478859, - "p90_m": 3.2874905594442314, - "p95_m": 3.8078227315923114 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 197.52543517598477, - 982.3740682141851, - 1797.700860325683, - 2475.1816459887004, - 12781.769899808036, - 29106.771106198827 - ], - "effective_rank": 6, - "scaled_condition_number": 147.35707874920627, - "weakest_scaled_direction": [ - 0.841779524638309, - 0.5304194403455533, - 0.014678775229690123, - 0.01875014102310592, - 0.0015491883702227335, - 0.09743210450347208 - ] - }, - "forward_reverse": { - "translation_m": 1.368389528072986, - "rotation_deg": 15.0277123732284 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.3514211068838185e-15, - "rotation_deg": 8.595858533834439e-15 - }, - { - "translation_m": 2.9326830094865e-06, - "rotation_deg": 2.917449677153293e-05 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784279817.2306573, - "frame_counter_i": 3843, - "frame_counter_j": 5003, - "rtk_translation_m": 0.17861948949299924, - "rtk_rotation_deg": 18.343509786783002, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9497011772029337, - 0.3131573096742153, - -0.00041643363182700653, - -0.011939255094270849 - ], - [ - -0.31315675348836103, - 0.9497008783913089, - 0.001043708487265888, - -0.22487171556642335 - ], - [ - 0.0007223323278941215, - -0.0008608021748267945, - 0.9999993686276126, - -0.008108960031756863 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 1, - "backend_num_inliers": 9152, - "backend_objective": 339.12881144131137, - "backend_elapsed_sec": 0.07012850000319304, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 3803, - "objective": 490.99182893543866 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6699, - "objective": 465.90461054238665 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 1, - "num_inliers": 9152, - "objective": 339.12881144131137 - } - ], - "heldout_symmetric": { - "evaluated": 7875, - "inliers": 6840, - "inlier_ratio": 0.8685714285714285, - "inlier_rmse_m": 0.07604325543622346, - "median_m": 0.042322570748859645, - "p90_m": 0.33847352497336086, - "p95_m": 0.6944785555129759 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 135609.3272694757, - 180074.45866804977, - 498102.8690296208, - 664960.1472842951, - 985516.3799545185, - 1677512.3397749867 - ], - "effective_rank": 6, - "scaled_condition_number": 12.370184068840063, - "weakest_scaled_direction": [ - 0.4192195836604045, - -0.4379513226189287, - -0.0519252030139154, - 0.050360931380883225, - 0.10600608260041684, - -0.7848463798897557 - ] - }, - "forward_reverse": { - "translation_m": 0.003904582263467037, - "rotation_deg": 0.011742002375313174 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4194586182185287e-15, - "rotation_deg": 6.684246314096771e-15 - }, - { - "translation_m": 6.927869652378367e-16, - "rotation_deg": 6.4856216887770025e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 3843, - "frame_counter_j": 1175, - "rtk_translation_m": 1.5807073315069207, - "rtk_rotation_deg": 50.90291130169636, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6303400891003206, - 0.7762792487704809, - 0.007867655390135333, - 1.1151391372078479 - ], - [ - -0.775754801951195, - 0.6302358901946093, - -0.03173657133766097, - -0.767431261583185 - ], - [ - -0.02959492055509659, - 0.013901461755725195, - 0.9994653020682561, - 0.028632837225913376 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 6375, - "backend_objective": 1687.9639518784425, - "backend_elapsed_sec": 0.11528220000036526, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3166, - "objective": 554.5062598679663 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5118, - "objective": 907.329589243708 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 6375, - "objective": 1687.9639518784425 - } - ], - "heldout_symmetric": { - "evaluated": 7851, - "inliers": 5356, - "inlier_ratio": 0.6822060883963826, - "inlier_rmse_m": 0.10567824422734254, - "median_m": 0.11608671218882977, - "p90_m": 1.4374789783336583, - "p95_m": 1.7910669029004254 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40887.29831497034, - 94467.9258278237, - 204878.81115575912, - 468908.8998990117, - 598187.3593323898, - 742657.3739280917 - ], - "effective_rank": 6, - "scaled_condition_number": 18.163522769519293, - "weakest_scaled_direction": [ - -0.6050800165167421, - -0.04297119998292753, - 0.02686719523224911, - 0.03976214131293449, - -0.09085289108082865, - 0.7883365573820255 - ] - }, - "forward_reverse": { - "translation_m": 0.011923922180697284, - "rotation_deg": 0.08008579261790838 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.952832160537328e-16, - "rotation_deg": 1.116957796093547e-14 - }, - { - "translation_m": 1.3954079410782014e-15, - "rotation_deg": 1.0240386821750424e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 3843, - "frame_counter_j": 2514, - "rtk_translation_m": 1.7804201387535592, - "rtk_rotation_deg": 75.18775779751417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2503724942278027, - 0.96799397516667, - -0.017357366596826268, - -0.15918729964223108 - ], - [ - -0.9677471996767486, - 0.24971136518595763, - -0.03331053309053324, - 0.3412203320194637 - ], - [ - -0.027910063632299555, - 0.025137584171775935, - 0.9992943161101475, - -0.024895064248734448 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8274, - "backend_objective": 1457.3718638477803, - "backend_elapsed_sec": 0.07581809999828693, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3810, - "objective": 671.6572323985032 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6504, - "objective": 1039.496217449071 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8274, - "objective": 1457.3718638477803 - } - ], - "heldout_symmetric": { - "evaluated": 7750, - "inliers": 6172, - "inlier_ratio": 0.7963870967741935, - "inlier_rmse_m": 0.10178391918503964, - "median_m": 0.09602177072532743, - "p90_m": 0.5984498738215269, - "p95_m": 1.406907621655736 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41795.79905532334, - 129300.40119213867, - 187819.95172150718, - 593180.2179818392, - 873149.9524008265, - 1058101.9389578856 - ], - "effective_rank": 6, - "scaled_condition_number": 25.315987799570973, - "weakest_scaled_direction": [ - 0.5018661838141184, - 0.2735784119799514, - -0.013738252098459736, - -0.07679774180162466, - 0.04838915834235573, - -0.8153876640474457 - ] - }, - "forward_reverse": { - "translation_m": 0.034377900701078094, - "rotation_deg": 0.11532260919614924 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7449076333954703e-15, - "rotation_deg": 1.022180504347879e-14 - }, - { - "translation_m": 2.37780414200531e-15, - "rotation_deg": 4.5108507313067996e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 8, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 3843, - "frame_counter_j": 3477, - "rtk_translation_m": 1.2818497736845669, - "rtk_rotation_deg": 104.01936417679076, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.23786179333613366, - 0.9712594761229233, - -0.008763407576007609, - -0.41880886438921183 - ], - [ - -0.9708732198031248, - -0.238014965629326, - -0.02746028414972834, - -0.744041651951136 - ], - [ - -0.02875688335045097, - 0.0019764052963914197, - 0.9995844814131891, - -0.058922257193260004 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 7344, - "backend_objective": 761.7332600582788, - "backend_elapsed_sec": 0.12878569999884348, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3477, - "objective": 655.3094040352206 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5866, - "objective": 1240.7459756823455 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 7344, - "objective": 761.7332600582788 - } - ], - "heldout_symmetric": { - "evaluated": 7773, - "inliers": 5776, - "inlier_ratio": 0.7430850379518847, - "inlier_rmse_m": 0.10189238984319506, - "median_m": 0.10064406334883068, - "p90_m": 0.8050527703513749, - "p95_m": 1.5495415520581153 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35985.044368082206, - 90333.22096808709, - 162501.62847261943, - 381523.9411063358, - 605990.4155638205, - 906693.6131931632 - ], - "effective_rank": 6, - "scaled_condition_number": 25.19640114706588, - "weakest_scaled_direction": [ - 0.3123970330023986, - 0.4572392015276092, - -0.026899458970475576, - -0.09610565369108542, - -0.05262330950894592, - -0.8249917066793603 - ] - }, - "forward_reverse": { - "translation_m": 0.034977663635135596, - "rotation_deg": 1.5753470469755222 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2571659638300647e-15, - "rotation_deg": 1.2199836501378328e-14 - }, - { - "translation_m": 2.4988112118961402e-15, - "rotation_deg": 6.463836559108607e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 4, - "j": 9, - "lidar_time_i": 1784279701.2360666, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 3843, - "frame_counter_j": 4392, - "rtk_translation_m": 1.5141865499370524, - "rtk_rotation_deg": 117.34615495378958, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4593350798978356, - 0.8877619717965263, - -0.029832294702073405, - 0.7931749314237349 - ], - [ - -0.8876749729551499, - -0.4575500904010168, - 0.051778925858833744, - 2.67427955494814 - ], - [ - 0.03231759218014098, - 0.05026525843924462, - 0.9982128916367059, - -0.8558075240621169 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 721, - "backend_objective": 40.87114215020113, - "backend_elapsed_sec": 0.14857350000238512, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 40, - "num_inliers": 1446, - "objective": 1356.019955358215 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 10, - "num_inliers": 1143, - "objective": 366.8492473889614 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 721, - "objective": 40.87114215020113 - } - ], - "heldout_symmetric": { - "evaluated": 7745, - "inliers": 652, - "inlier_ratio": 0.0841833440929632, - "inlier_rmse_m": 0.15176056899798168, - "median_m": 1.2016681829095166, - "p90_m": 3.300831941451601, - "p95_m": 3.6280368538059213 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 613.8013160849656, - 747.1230290796893, - 1080.4951182203274, - 2888.73215756241, - 6693.067058844119, - 52102.62428591885 - ], - "effective_rank": 6, - "scaled_condition_number": 84.88516221869183, - "weakest_scaled_direction": [ - -0.4691335141131807, - -0.599360657326981, - 0.38482446718466956, - 0.15786448620199311, - -0.4770044804925983, - 0.14190210508159923 - ] - }, - "forward_reverse": { - "translation_m": 3.340127368239112, - "rotation_deg": 6.177861200193235 - }, - "multistart": { - "runs": 2, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 3.3466185794959404, - "rotation_deg": 4.671218041961471 - }, - { - "translation_m": 0.40800635488041054, - "rotation_deg": 4.432101856966071 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784280797.6884267, - "frame_counter_i": 5003, - "frame_counter_j": 1175, - "rtk_translation_m": 1.5316987521992935, - "rtk_rotation_deg": 32.55940151491337, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8416347614443656, - 0.5396602943927136, - 0.020437587540027207, - 1.2406941902208743 - ], - [ - -0.5392333430361893, - 0.8418412916299091, - -0.023035656380973452, - -0.16363127865569102 - ], - [ - -0.02963663419658135, - 0.008366980510111326, - 0.9995257193042318, - 0.02498735709253317 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6357, - "backend_objective": 1439.7400504342668, - "backend_elapsed_sec": 0.08830589999706717, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3203, - "objective": 640.8318078589004 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5105, - "objective": 990.0222931980452 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6357, - "objective": 1439.7400504342668 - } - ], - "heldout_symmetric": { - "evaluated": 7772, - "inliers": 5335, - "inlier_ratio": 0.6864384971693258, - "inlier_rmse_m": 0.10315026388508003, - "median_m": 0.1126235750497052, - "p90_m": 1.2674528348985197, - "p95_m": 1.665986570460006 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 62628.17442259263, - 103727.25852686747, - 281249.3658130418, - 414540.2720205326, - 558761.7547888304, - 720563.8397959737 - ], - "effective_rank": 6, - "scaled_condition_number": 11.505426214947052, - "weakest_scaled_direction": [ - 0.6021970724827131, - 0.11657901256334291, - -0.017139939091172087, - -0.06511379024593597, - 0.08928678973576651, - -0.7818326583799412 - ] - }, - "forward_reverse": { - "translation_m": 0.002552272421554712, - "rotation_deg": 0.013899678900349944 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.432246110830866e-16, - "rotation_deg": 5.443650243080799e-15 - }, - { - "translation_m": 5.785972455716595e-16, - "rotation_deg": 8.805218369935123e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 5003, - "frame_counter_j": 2514, - "rtk_translation_m": 1.6091514152462776, - "rtk_rotation_deg": 56.844248010731185, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5408147473873567, - 0.8411323032825557, - -0.003982132962699763, - -0.31824311903689734 - ], - [ - -0.840768707169636, - 0.5404278773068721, - -0.03233713768853341, - 0.4826546689444158 - ], - [ - -0.025047755441335688, - 0.02083645373308103, - 0.999469085136294, - 0.032537410509367704 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8370, - "backend_objective": 2588.7177978889486, - "backend_elapsed_sec": 0.07422799999767449, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3756, - "objective": 592.008631214237 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6392, - "objective": 1076.3934277199323 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8370, - "objective": 2588.7177978889486 - } - ], - "heldout_symmetric": { - "evaluated": 7671, - "inliers": 6217, - "inlier_ratio": 0.8104549602398644, - "inlier_rmse_m": 0.09862238510016193, - "median_m": 0.08602550768091202, - "p90_m": 0.6272493234515611, - "p95_m": 1.27815527811686 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68119.10857080169, - 130708.02640510672, - 210826.10546247533, - 524457.2191131447, - 918555.920342475, - 1125143.7472422884 - ], - "effective_rank": 6, - "scaled_condition_number": 16.517299930207333, - "weakest_scaled_direction": [ - -0.31058415852658877, - -0.4615012602091193, - -0.002244507476472212, - 0.11069835715920352, - -0.021380198124019208, - 0.8233090491026718 - ] - }, - "forward_reverse": { - "translation_m": 0.0037398303757535147, - "rotation_deg": 0.02129636862756259 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7264910232588054e-15, - "rotation_deg": 4.9948384185585995e-14 - }, - { - "translation_m": 9.877266258705691e-16, - "rotation_deg": 4.459273158235072e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 5003, - "frame_counter_j": 3477, - "rtk_translation_m": 1.1872485760158462, - "rtk_rotation_deg": 85.67585439000777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.07753679163061511, - 0.9969833171659289, - -0.0035087371590630917, - -0.22471740031526596 - ], - [ - -0.9963970035492264, - 0.07736892102726545, - -0.034742788851779526, - -0.6099979606488117 - ], - [ - -0.0343665136688776, - 0.006189939571399176, - 0.9993901277210763, - -0.12813572737467172 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7757, - "backend_objective": 811.9396406070998, - "backend_elapsed_sec": 0.07958649999636691, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3598, - "objective": 718.0624204669459 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6084, - "objective": 941.705707692279 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7757, - "objective": 811.9396406070998 - } - ], - "heldout_symmetric": { - "evaluated": 7694, - "inliers": 6006, - "inlier_ratio": 0.7806082661814401, - "inlier_rmse_m": 0.10305777405801758, - "median_m": 0.09580148483315103, - "p90_m": 0.5989323579031789, - "p95_m": 1.1025733788084007 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50744.78445916037, - 114458.24946064551, - 167372.09919143195, - 376523.4974810915, - 598932.3721729278, - 900101.819252911 - ], - "effective_rank": 6, - "scaled_condition_number": 17.737819341361416, - "weakest_scaled_direction": [ - 0.2750143227172107, - 0.47009605746037775, - -0.011321602209642487, - -0.0968643633688171, - -0.049385105996692685, - -0.8315209238490988 - ] - }, - "forward_reverse": { - "translation_m": 0.0056799616182010805, - "rotation_deg": 0.026182015145595202 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.1540741810552243e-16, - "rotation_deg": 3.1134886992265742e-15 - }, - { - "translation_m": 8.707689814785864e-16, - "rotation_deg": 8.371531382125908e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 9, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 5003, - "frame_counter_j": 4392, - "rtk_translation_m": 1.380208837139288, - "rtk_rotation_deg": 99.00264516700663, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1539641505589304, - 0.9880660460691288, - -0.004530888211502086, - -0.6982969285021847 - ], - [ - -0.9873667366532588, - -0.15402571495883738, - -0.037188795115108336, - -0.18310721660694143 - ], - [ - -0.037442859043635174, - -0.0012520929426762233, - 0.9992979858730332, - -0.05002770963023162 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7823, - "backend_objective": 1820.8392542446177, - "backend_elapsed_sec": 0.10721089999424294, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3473, - "objective": 698.9503978721926 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 10, - "num_inliers": 5889, - "objective": 1001.273137640962 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7823, - "objective": 1820.8392542446177 - } - ], - "heldout_symmetric": { - "evaluated": 7666, - "inliers": 6092, - "inlier_ratio": 0.7946777980693973, - "inlier_rmse_m": 0.10313535699942489, - "median_m": 0.09091462351713185, - "p90_m": 0.6207334964868284, - "p95_m": 1.2045963032038793 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 58884.275004634066, - 111739.89078912334, - 187534.49871464988, - 447075.78852280846, - 696546.7145041347, - 833065.2597949916 - ], - "effective_rank": 6, - "scaled_condition_number": 14.147499646203187, - "weakest_scaled_direction": [ - 0.1949644587747009, - 0.5330247711849555, - -0.0020037473690106564, - -0.07480859843058951, - -0.06935371779659949, - -0.8169841941818916 - ] - }, - "forward_reverse": { - "translation_m": 0.06270036555847405, - "rotation_deg": 0.33857191756776234 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6736404963781187e-15, - "rotation_deg": 6.171093133326987e-15 - }, - { - "translation_m": 1.0068810866857322e-15, - "rotation_deg": 4.969631272353031e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 10, - "lidar_time_i": 1784279817.2306573, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 5003, - "frame_counter_j": 5391, - "rtk_translation_m": 1.7506315276318887, - "rtk_rotation_deg": 115.10127466723206, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4246260259050521, - 0.9049342057637234, - -0.028050336234381575, - -1.2071709129911874 - ], - [ - -0.9043052942146059, - -0.4254248977587171, - -0.03529293445463514, - 0.4295246456216637 - ], - [ - -0.04387109503438577, - 0.010379769061251844, - 0.9989832768443715, - -0.01457071084844123 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7813, - "backend_objective": 1662.890071698616, - "backend_elapsed_sec": 0.10118969999894034, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3571, - "objective": 736.6433499400223 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5940, - "objective": 605.8350833906063 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7813, - "objective": 1662.890071698616 - } - ], - "heldout_symmetric": { - "evaluated": 7786, - "inliers": 6110, - "inlier_ratio": 0.7847418443359877, - "inlier_rmse_m": 0.10018431236036145, - "median_m": 0.08564893545217507, - "p90_m": 0.7047935454611245, - "p95_m": 1.3357726174361493 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38822.34903708502, - 127476.48722963654, - 214349.3640082268, - 532268.7366328945, - 637908.9278508682, - 831789.2613601788 - ], - "effective_rank": 6, - "scaled_condition_number": 21.425526326745782, - "weakest_scaled_direction": [ - 0.007386655478794687, - -0.571192310205916, - 0.012872319890357604, - 0.05260339183350326, - 0.06957821176834754, - 0.8160336029097313 - ] - }, - "forward_reverse": { - "translation_m": 0.005291671170548772, - "rotation_deg": 0.044796841001461946 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.220471033417173e-16, - "rotation_deg": 3.3392196719287053e-15 - }, - { - "translation_m": 1.123727302964262e-15, - "rotation_deg": 2.5323322246361575e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784280931.5831878, - "frame_counter_i": 1175, - "frame_counter_j": 2514, - "rtk_translation_m": 1.5692385974903325, - "rtk_rotation_deg": 24.284846495817817, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.909483115746497, - 0.4155765106489391, - -0.01168871117349643, - -1.6592198957151778 - ], - [ - -0.41570805189186927, - 0.909405045095404, - -0.013010747376446618, - -0.30168239407992625 - ], - [ - 0.005222811916202157, - 0.016692146413182157, - 0.999847035542842, - -0.007892748951345127 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7243, - "backend_objective": 1522.6064745708366, - "backend_elapsed_sec": 0.08411139999952866, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3582, - "objective": 605.1448043777464 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5796, - "objective": 605.8822090073054 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7243, - "objective": 1522.6064745708366 - } - ], - "heldout_symmetric": { - "evaluated": 7647, - "inliers": 5644, - "inlier_ratio": 0.7380672159016608, - "inlier_rmse_m": 0.1046107504689679, - "median_m": 0.10516702793043524, - "p90_m": 1.3466635213081777, - "p95_m": 2.3116144655216293 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 59044.43047453538, - 106085.72604302097, - 153287.8139048446, - 545038.8178828656, - 595764.3640367957, - 823495.8743371702 - ], - "effective_rank": 6, - "scaled_condition_number": 13.947054238965462, - "weakest_scaled_direction": [ - 0.34187136754149705, - 0.42311559300190416, - -0.010062452362094805, - -0.1511398270574222, - -0.0313405145279167, - -0.8247244599819952 - ] - }, - "forward_reverse": { - "translation_m": 0.010178220865611676, - "rotation_deg": 0.026255002379027764 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.99864538245492e-14, - "rotation_deg": 2.2180121790453937e-13 - }, - { - "translation_m": 3.3623259593535718e-15, - "rotation_deg": 2.998399929153121e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 1175, - "frame_counter_j": 3477, - "rtk_translation_m": 0.5035712140385419, - "rtk_rotation_deg": 53.11645287509441, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6037182959994388, - 0.7970572268726047, - 0.014966501451125668, - -1.0160210845265023 - ], - [ - -0.7964800450607912, - 0.6038649306759996, - -0.031091531316915836, - -1.1762971501094048 - ], - [ - -0.03381947509192992, - 0.006850006556466645, - 0.9994044829370549, - -0.1098236036460156 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 18, - "backend_num_inliers": 6592, - "backend_objective": 961.5407765512243, - "backend_elapsed_sec": 0.15934769999876153, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3401, - "objective": 719.6060307225272 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5455, - "objective": 812.0520870314114 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 18, - "num_inliers": 6592, - "objective": 961.5407765512243 - } - ], - "heldout_symmetric": { - "evaluated": 7670, - "inliers": 5389, - "inlier_ratio": 0.7026075619295958, - "inlier_rmse_m": 0.10337241424878332, - "median_m": 0.10987637314182283, - "p90_m": 1.2288508465715133, - "p95_m": 1.9516293078468219 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38322.210714207744, - 57041.143566057144, - 103833.6423646101, - 296720.122264882, - 538672.7762647731, - 813689.683832759 - ], - "effective_rank": 6, - "scaled_condition_number": 21.232848227388097, - "weakest_scaled_direction": [ - 0.06723189230963834, - -0.51901775622102, - 0.012374948724912054, - 0.11338087925672095, - 0.1928204214302581, - 0.8221388953980033 - ] - }, - "forward_reverse": { - "translation_m": 0.017447450845101884, - "rotation_deg": 0.1292664848366822 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2576478019879053e-15, - "rotation_deg": 3.6830228253657206e-15 - }, - { - "translation_m": 1.7668446017851345e-15, - "rotation_deg": 2.2215586891688402e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 1175, - "frame_counter_j": 4392, - "rtk_translation_m": 0.8508108569116883, - "rtk_rotation_deg": 66.44324365209327, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.40483561953554525, - 0.9141614193876847, - 0.02042107877573947, - -1.642682796688597 - ], - [ - -0.9138622071583618, - 0.4052595813876793, - -0.024910600577469185, - -1.0797029069001558 - ], - [ - -0.031048147817839888, - -0.008577353704769804, - 0.9994810861244467, - 0.013751147427213468 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 6148, - "backend_objective": 667.8998123584665, - "backend_elapsed_sec": 0.12123180000344291, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3292, - "objective": 961.320200572275 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5272, - "objective": 631.7393643215679 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 6148, - "objective": 667.8998123584665 - } - ], - "heldout_symmetric": { - "evaluated": 7642, - "inliers": 5131, - "inlier_ratio": 0.6714210939544621, - "inlier_rmse_m": 0.10949604778423808, - "median_m": 0.1301032933452151, - "p90_m": 1.2752680335322666, - "p95_m": 1.8376320418668735 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 19922.866151825405, - 62805.101264230296, - 95018.08492275006, - 344595.8811452952, - 553290.1779658088, - 681602.2011302372 - ], - "effective_rank": 6, - "scaled_condition_number": 34.21205543097956, - "weakest_scaled_direction": [ - -0.299940954061248, - -0.49166088297910443, - 0.029656300667359026, - 0.05887750540950749, - 0.07174793700674935, - 0.8116718406768784 - ] - }, - "forward_reverse": { - "translation_m": 0.09491078892598759, - "rotation_deg": 0.32255986251320673 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6314465605303521e-15, - "rotation_deg": 1.2489684930489784e-14 - }, - { - "translation_m": 2.511297604186124e-07, - "rotation_deg": 1.1630680565688636e-06 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 6, - "j": 10, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 1175, - "frame_counter_j": 5391, - "rtk_translation_m": 1.3331914459292633, - "rtk_rotation_deg": 82.5418731523187, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1313103761972247, - 0.9907476024909292, - -0.034304128926703766, - -2.3787091430480056 - ], - [ - -0.990558635987872, - 0.1297533570277591, - -0.04424539535221548, - -0.8225932109866378 - ], - [ - -0.0393849434783179, - 0.0397901306670821, - 0.9984315558558364, - -0.08900040735175659 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6447, - "backend_objective": 740.472081401316, - "backend_elapsed_sec": 0.09819309999875259, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3399, - "objective": 726.7054126558432 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5248, - "objective": 433.12994104124334 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6447, - "objective": 740.472081401316 - } - ], - "heldout_symmetric": { - "evaluated": 7762, - "inliers": 5138, - "inlier_ratio": 0.6619427982478743, - "inlier_rmse_m": 0.10510077922086615, - "median_m": 0.12354731445283715, - "p90_m": 1.3851071188823552, - "p95_m": 2.152900914798458 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21952.742165067175, - 95623.17052108268, - 145562.1501816274, - 249390.01995002426, - 489389.5752488462, - 682764.6689305834 - ], - "effective_rank": 6, - "scaled_condition_number": 31.101566437428897, - "weakest_scaled_direction": [ - 0.09653727604530707, - 0.593778957443998, - -0.02350843135913059, - -0.042181713994409675, - -0.0855560206460835, - -0.7927517442561728 - ] - }, - "forward_reverse": { - "translation_m": 0.003562383894956786, - "rotation_deg": 0.04536548719264196 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2180530976352345e-11, - "rotation_deg": 8.803349592612921e-10 - }, - { - "translation_m": 3.4402658798855987e-15, - "rotation_deg": 5.083516473853711e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 11, - "lidar_time_i": 1784280797.6884267, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 1175, - "frame_counter_j": 6461, - "rtk_translation_m": 3.16887584646763, - "rtk_rotation_deg": 119.46156331049859, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4857590976363869, - 0.8729319203500212, - -0.045032893505818315, - -3.58786635988802 - ], - [ - -0.8732598486396753, - -0.48690027885228976, - -0.018583735022171116, - 1.5241206950738497 - ], - [ - -0.03814886390568818, - 0.03029819941161397, - 0.998812636731794, - -0.13404186365698315 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6499, - "backend_objective": 983.9998126385315, - "backend_elapsed_sec": 0.12275450000015553, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3448, - "objective": 788.1110639840875 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5302, - "objective": 632.7445405242505 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6499, - "objective": 983.9998126385315 - } - ], - "heldout_symmetric": { - "evaluated": 8025, - "inliers": 5120, - "inlier_ratio": 0.638006230529595, - "inlier_rmse_m": 0.1061575017783152, - "median_m": 0.13580485311919038, - "p90_m": 1.5685737228908871, - "p95_m": 2.59770485473636 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21555.779552753564, - 78238.88624937875, - 150128.77344726393, - 264326.6000904365, - 426487.85096617, - 688562.880506363 - ], - "effective_rank": 6, - "scaled_condition_number": 31.943306843588733, - "weakest_scaled_direction": [ - 0.3083245026658187, - -0.6327938869992662, - 0.05217049840297786, - 0.05844281302263846, - 0.100326372060064, - 0.6987883752638465 - ] - }, - "forward_reverse": { - "translation_m": 0.0059304520508679575, - "rotation_deg": 0.05963953472442965 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.75767166992686e-15, - "rotation_deg": 1.1319783582927137e-14 - }, - { - "translation_m": 4.448739829332789e-15, - "rotation_deg": 1.750901810005333e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281027.8795433, - "frame_counter_i": 2514, - "frame_counter_j": 3477, - "rtk_translation_m": 1.1230406357307108, - "rtk_rotation_deg": 28.831606379276582, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8800631259153807, - 0.4747564088511788, - 0.009759439470644279, - 0.9913144468561514 - ], - [ - -0.474617716962652, - 0.8800863786690545, - -0.013637772044909192, - -0.5116990871578355 - ], - [ - -0.015063769422331246, - 0.007370097415971796, - 0.9998593723693697, - 0.10374868317784489 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7550, - "backend_objective": 709.5925759017508, - "backend_elapsed_sec": 0.08944139999948675, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3414, - "objective": 664.2651282303233 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5811, - "objective": 842.928227649006 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7550, - "objective": 709.5925759017508 - } - ], - "heldout_symmetric": { - "evaluated": 7569, - "inliers": 6086, - "inlier_ratio": 0.8040692297529396, - "inlier_rmse_m": 0.09680052952350976, - "median_m": 0.07998200977376978, - "p90_m": 0.5559824474834514, - "p95_m": 1.073078967558813 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43744.527834096516, - 118000.62221855714, - 167646.24315015168, - 391056.47885848465, - 603791.4532548424, - 971994.832129231 - ], - "effective_rank": 6, - "scaled_condition_number": 22.21980394474879, - "weakest_scaled_direction": [ - 0.047710464157071975, - -0.5236808792417601, - -0.007019791587059019, - 0.09088199119327751, - 0.10175245703480502, - 0.8395353905683146 - ] - }, - "forward_reverse": { - "translation_m": 0.008328073875015064, - "rotation_deg": 0.06350723756646647 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.651732253995449e-16, - "rotation_deg": 4.843556592333691e-15 - }, - { - "translation_m": 8.551535750647283e-16, - "rotation_deg": 3.471304699249106e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 2514, - "frame_counter_j": 4392, - "rtk_translation_m": 0.7186795671679719, - "rtk_rotation_deg": 42.158397156275456, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7469031259449787, - 0.6647222063108584, - 0.016736453950689355, - 0.3576910998013705 - ], - [ - -0.6644590009153541, - 0.7470844637942274, - -0.018948352431300747, - -0.6772592055531916 - ], - [ - -0.02509893535965749, - 0.003031896191504787, - 0.9996803744444, - 0.0030382320563910204 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7897, - "backend_objective": 675.5189904887212, - "backend_elapsed_sec": 0.08194750000257045, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3425, - "objective": 664.8082672169558 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5863, - "objective": 509.2534493040819 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7897, - "objective": 675.5189904887212 - } - ], - "heldout_symmetric": { - "evaluated": 7541, - "inliers": 6240, - "inlier_ratio": 0.8274764620076913, - "inlier_rmse_m": 0.09296346258223728, - "median_m": 0.06944731104618744, - "p90_m": 0.4528730457339926, - "p95_m": 0.8590747847790592 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47272.64347442783, - 99364.32983077645, - 155668.75630850272, - 525640.1091126871, - 750164.4056888522, - 1044553.1228244945 - ], - "effective_rank": 6, - "scaled_condition_number": 22.096355228992984, - "weakest_scaled_direction": [ - 0.006939269296551777, - -0.5264304778533415, - 0.008176831521086947, - 0.06033996953085957, - 0.11542986109637406, - 0.8401136668328253 - ] - }, - "forward_reverse": { - "translation_m": 0.0076981468910999155, - "rotation_deg": 0.020277033650542 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1000685477095392e-09, - "rotation_deg": 3.210355754106942e-09 - }, - { - "translation_m": 1.3434987503168181e-06, - "rotation_deg": 2.7547986387577436e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 2514, - "frame_counter_j": 5391, - "rtk_translation_m": 0.39293571356254015, - "rtk_rotation_deg": 58.25702665650087, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5312169782982826, - 0.8472017024943965, - 0.007602450804723118, - -0.44342558914297037 - ], - [ - -0.8466270129886356, - 0.5311540007806855, - -0.033138019443121856, - -0.7795955525921993 - ], - [ - -0.032112658650172286, - 0.011167038339169153, - 0.9994218700874763, - -0.002156534886767799 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7853, - "backend_objective": 1403.437939389646, - "backend_elapsed_sec": 0.10532090000197059, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3586, - "objective": 732.0385320319808 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6078, - "objective": 738.8925482598307 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7853, - "objective": 1403.437939389646 - } - ], - "heldout_symmetric": { - "evaluated": 7661, - "inliers": 6123, - "inlier_ratio": 0.7992429186790236, - "inlier_rmse_m": 0.10479299924479576, - "median_m": 0.09471165278285745, - "p90_m": 0.5578200026280847, - "p95_m": 1.0683780270975514 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 30470.746157274167, - 100431.84116809552, - 175554.94588600568, - 591511.0477570589, - 674461.4647742057, - 921643.9542310045 - ], - "effective_rank": 6, - "scaled_condition_number": 30.246845596558646, - "weakest_scaled_direction": [ - 0.05946138447315555, - -0.5408557906382165, - 0.01655582699563641, - 0.04055737234328575, - 0.08243753869910733, - 0.8338011836427054 - ] - }, - "forward_reverse": { - "translation_m": 0.04240408437264065, - "rotation_deg": 1.1111803590641476 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6488927616899812e-15, - "rotation_deg": 5.234723027700383e-15 - }, - { - "translation_m": 1.932282620050304e-15, - "rotation_deg": 3.551700433246251e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 7, - "j": 11, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 2514, - "frame_counter_j": 6461, - "rtk_translation_m": 2.4544901278439815, - "rtk_rotation_deg": 95.17671681468076, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07892745251987834, - 0.9966967730783476, - -0.019131120561277023, - -2.5157398992729094 - ], - [ - -0.996683069287662, - -0.07927909003791796, - -0.018376215009784678, - 0.8572540013446737 - ], - [ - -0.019832212031150036, - 0.01761727612224602, - 0.9996480955556232, - -0.04958576775212753 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7827, - "backend_objective": 1378.0184927435484, - "backend_elapsed_sec": 0.08875300000363495, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3751, - "objective": 836.936150074981 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6198, - "objective": 686.8920225811343 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7827, - "objective": 1378.0184927435484 - } - ], - "heldout_symmetric": { - "evaluated": 7924, - "inliers": 5945, - "inlier_ratio": 0.7502523977788995, - "inlier_rmse_m": 0.1028589368143411, - "median_m": 0.10154308971806741, - "p90_m": 0.7624795515981605, - "p95_m": 1.3811188840667292 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40938.38139063414, - 110407.35702347028, - 162460.72471857662, - 477847.9723084117, - 588547.8143019809, - 815954.5332453119 - ], - "effective_rank": 6, - "scaled_condition_number": 19.931284665592216, - "weakest_scaled_direction": [ - -0.37228079954793214, - 0.5117613941140013, - -0.037229198895721446, - -0.06094685657928835, - -0.09861408819267546, - -0.7646450227491572 - ] - }, - "forward_reverse": { - "translation_m": 0.005620519728387707, - "rotation_deg": 0.0303880139721275 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.265337574760008e-15, - "rotation_deg": 5.3463020512133144e-14 - }, - { - "translation_m": 1.1811823737098024e-15, - "rotation_deg": 1.2514366082410309e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 12, - "lidar_time_i": 1784280931.5831878, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 2514, - "frame_counter_j": 7268, - "rtk_translation_m": 3.0905023273107046, - "rtk_rotation_deg": 115.3786462164333, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4217029830986348, - 0.9066257671772938, - -0.014011150413015625, - -3.2481105467476654 - ], - [ - -0.9062974979538774, - -0.4219290656169286, - -0.024509361276196347, - 1.5476712238287145 - ], - [ - -0.028132530072038912, - 0.0023625997987573614, - 0.9996014099999739, - -0.05834431855363248 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7651, - "backend_objective": 1715.6274646717313, - "backend_elapsed_sec": 0.09876149999763584, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3764, - "objective": 889.9878155410244 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6155, - "objective": 732.5705349013787 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7651, - "objective": 1715.6274646717313 - } - ], - "heldout_symmetric": { - "evaluated": 8012, - "inliers": 5652, - "inlier_ratio": 0.7054418372441338, - "inlier_rmse_m": 0.10706084863640537, - "median_m": 0.11521385120998624, - "p90_m": 0.9451847574651885, - "p95_m": 1.541527242057654 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 66413.05235785422, - 107164.70240912262, - 187078.33770968564, - 474345.43769900966, - 615928.4280826901, - 714736.2735629587 - ], - "effective_rank": 6, - "scaled_condition_number": 10.761985004268995, - "weakest_scaled_direction": [ - 0.5702678997823777, - -0.3140474522489734, - 0.047846659537840244, - 0.09331843231404238, - 0.1072447177730774, - 0.7440898185602445 - ] - }, - "forward_reverse": { - "translation_m": 0.004629206980441498, - "rotation_deg": 0.07009059694702204 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.568485407988665e-16, - "rotation_deg": 5.548631930575004e-15 - }, - { - "translation_m": 2.2155074372508703e-15, - "rotation_deg": 9.799686929159528e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281119.375541, - "frame_counter_i": 3477, - "frame_counter_j": 4392, - "rtk_translation_m": 0.4407680716864947, - "rtk_rotation_deg": 13.326790776998866, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.973121375084289, - 0.23021659495168226, - 0.0059252647970986375, - -0.4714457251687161 - ], - [ - -0.23022224264347577, - 0.973138037750673, - 0.00028013385782141596, - -0.44286760249929075 - ], - [ - -0.005701609094923384, - -0.001636731994775328, - 0.9999824062262825, - -0.04670080405122055 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8512, - "backend_objective": 479.78302148331, - "backend_elapsed_sec": 0.07271269999910146, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3545, - "objective": 545.371105541863 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6286, - "objective": 493.7181216523776 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8512, - "objective": 479.78302148331 - } - ], - "heldout_symmetric": { - "evaluated": 7564, - "inliers": 6459, - "inlier_ratio": 0.8539132734003173, - "inlier_rmse_m": 0.09158655960119419, - "median_m": 0.06516566992720596, - "p90_m": 0.33720271285301373, - "p95_m": 0.52360290086918 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40459.348364572754, - 129472.34899747808, - 194104.5458434656, - 485052.53186167666, - 732024.4550990176, - 1266086.6554866363 - ], - "effective_rank": 6, - "scaled_condition_number": 31.292808872701826, - "weakest_scaled_direction": [ - -0.28917065473166614, - -0.5097201706867877, - 0.0121061311877005, - 0.06469116337776021, - 0.08274888879766164, - 0.8033596930443683 - ] - }, - "forward_reverse": { - "translation_m": 0.0036696927581956673, - "rotation_deg": 0.014909075167693285 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.438628675679424e-15, - "rotation_deg": 4.930053260654035e-15 - }, - { - "translation_m": 7.005534227155538e-16, - "rotation_deg": 3.449307589743427e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 3477, - "frame_counter_j": 5391, - "rtk_translation_m": 0.968166048306331, - "rtk_rotation_deg": 29.425420277224287, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8696462228790053, - 0.49366158210724626, - 0.0036999167085011836, - -1.1263494710947692 - ], - [ - -0.493467001435117, - 0.8694723850437479, - -0.02254085492990772, - -0.9077256500685795 - ], - [ - -0.01434452951175191, - 0.017776782546554095, - 0.9997390761970739, - -0.02342016946147034 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7830, - "backend_objective": 1334.225814669529, - "backend_elapsed_sec": 0.08632039999793051, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3505, - "objective": 635.492197811527 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5935, - "objective": 797.9877031953356 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7830, - "objective": 1334.225814669529 - } - ], - "heldout_symmetric": { - "evaluated": 7684, - "inliers": 6139, - "inlier_ratio": 0.7989328474752733, - "inlier_rmse_m": 0.09757506446655329, - "median_m": 0.08426000873112457, - "p90_m": 0.59455758252269, - "p95_m": 1.1765435179549268 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31993.56981345975, - 98857.76222049227, - 154794.993132006, - 466806.8012269378, - 679946.4451454231, - 814535.4823015732 - ], - "effective_rank": 6, - "scaled_condition_number": 25.45934970841849, - "weakest_scaled_direction": [ - 0.024122766856109864, - 0.5574141342919444, - -0.01769516894817715, - -0.03666022975063217, - -0.09995854753391142, - -0.8228358112869203 - ] - }, - "forward_reverse": { - "translation_m": 0.008689580645481346, - "rotation_deg": 0.052297435035790506 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3631041599634778e-15, - "rotation_deg": 4.80615034112245e-15 - }, - { - "translation_m": 1.1157819071397953e-15, - "rotation_deg": 5.704389825159264e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 3477, - "frame_counter_j": 6461, - "rtk_translation_m": 3.0540124804140354, - "rtk_rotation_deg": 66.34511043540417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.40416229480648863, - 0.9142596089747338, - -0.027967961207786517, - -3.7218849975325115 - ], - [ - -0.9146872711630312, - 0.4039796036482277, - -0.012152193569423729, - -0.4570670799943488 - ], - [ - 0.00018822614260399214, - 0.030493396557094737, - 0.9995349505331619, - -0.09089735062752104 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7075, - "backend_objective": 1180.1255295379838, - "backend_elapsed_sec": 0.09884829999646172, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3590, - "objective": 750.8165557022828 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5683, - "objective": 594.9436628943748 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7075, - "objective": 1180.1255295379838 - } - ], - "heldout_symmetric": { - "evaluated": 7947, - "inliers": 5447, - "inlier_ratio": 0.6854158802063672, - "inlier_rmse_m": 0.10755838259974337, - "median_m": 0.12116932559223641, - "p90_m": 1.037723387367619, - "p95_m": 1.8283070150123621 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16802.856622076477, - 35344.468661394196, - 104792.94272314866, - 377398.79212950746, - 477520.5768480696, - 713609.9472931538 - ], - "effective_rank": 6, - "scaled_condition_number": 42.46956117899474, - "weakest_scaled_direction": [ - -0.4733694685342991, - 0.3833754654557906, - -0.024187758997156132, - -0.024357035241185227, - -0.11640379575063797, - -0.7837196196535534 - ] - }, - "forward_reverse": { - "translation_m": 0.00234148729464824, - "rotation_deg": 0.061662020462905004 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.184190671000836e-15, - "rotation_deg": 8.809674655944377e-15 - }, - { - "translation_m": 3.542099747707657e-15, - "rotation_deg": 1.3899415708282095e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 12, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 3477, - "frame_counter_j": 7268, - "rtk_translation_m": 3.652970846697932, - "rtk_rotation_deg": 86.5470398371567, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.059552595790802555, - 0.998074049558884, - -0.0173689358254449, - -4.697109417690808 - ], - [ - -0.9980580871791012, - 0.0592152732546964, - -0.019328891064015485, - -0.1956054465506786 - ], - [ - -0.018263158296697425, - 0.018486292502899872, - 0.9996622999986179, - -0.14985746738366088 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6921, - "backend_objective": 902.2249291134908, - "backend_elapsed_sec": 0.08737330000440124, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3519, - "objective": 1369.4962829684148 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5511, - "objective": 488.0565764122197 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6921, - "objective": 902.2249291134908 - } - ], - "heldout_symmetric": { - "evaluated": 8035, - "inliers": 5211, - "inlier_ratio": 0.6485376477909147, - "inlier_rmse_m": 0.11031208403019, - "median_m": 0.13677415454563993, - "p90_m": 1.265682763242391, - "p95_m": 2.1620106706576645 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22022.25319393659, - 33419.895116884865, - 104736.3479898866, - 354355.7403016652, - 432677.4541636953, - 661761.3164998644 - ], - "effective_rank": 6, - "scaled_condition_number": 30.049664340525695, - "weakest_scaled_direction": [ - -0.6691090588850369, - -0.32168670556957213, - 0.001353676724725272, - 0.09542167916084411, - -0.12952048161443735, - -0.6503291830493142 - ] - }, - "forward_reverse": { - "translation_m": 0.013830104055554564, - "rotation_deg": 0.11563630256710061 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.533130983835988e-12, - "rotation_deg": 5.2181824348966285e-11 - }, - { - "translation_m": 4.825216067493316e-13, - "rotation_deg": 1.640990144066156e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 13, - "lidar_time_i": 1784281027.8795433, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 3477, - "frame_counter_j": 7942, - "rtk_translation_m": 4.357531202056024, - "rtk_rotation_deg": 107.49623325505803, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.30119158386904127, - 0.9533974481546617, - -0.017802686837604977, - -5.09855201527271 - ], - [ - -0.953018716240013, - -0.3015980775197574, - -0.028176694849169424, - 1.4809333839269747 - ], - [ - -0.03223284509153864, - 0.008479710405781278, - 0.9994444147668939, - -0.1033278998569099 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6823, - "backend_objective": 1384.1415857115712, - "backend_elapsed_sec": 0.09610930000053486, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3403, - "objective": 1092.8737844394902 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5417, - "objective": 555.1709110313604 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6823, - "objective": 1384.1415857115712 - } - ], - "heldout_symmetric": { - "evaluated": 8016, - "inliers": 4993, - "inlier_ratio": 0.622879241516966, - "inlier_rmse_m": 0.1149201207874094, - "median_m": 0.15416822179795658, - "p90_m": 1.4862880387750954, - "p95_m": 2.2538456598295538 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24682.965557581614, - 35390.78428411787, - 72250.41540171055, - 327388.91412231163, - 454053.63418943994, - 667491.0145750556 - ], - "effective_rank": 6, - "scaled_condition_number": 27.04257772502661, - "weakest_scaled_direction": [ - 0.2985992975106704, - -0.9365982781660924, - 0.07620969750582711, - 0.14188505099048573, - 0.03735646117607596, - 0.0792927107768602 - ] - }, - "forward_reverse": { - "translation_m": 0.005835943764379069, - "rotation_deg": 0.23887217550290574 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8914564400730272e-15, - "rotation_deg": 1.2166057495719218e-14 - }, - { - "translation_m": 4.717654291880836e-07, - "rotation_deg": 2.9201063680953924e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281219.2718523, - "frame_counter_i": 4392, - "frame_counter_j": 5391, - "rtk_translation_m": 0.5276649044820116, - "rtk_rotation_deg": 16.098629500225417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9600150038776836, - 0.27994326947499204, - 0.0017199434243572863, - -0.5284564934999215 - ], - [ - -0.27985738284879363, - 0.9598410298660851, - -0.019622503679124912, - -0.6095206340608372 - ], - [ - -0.007144060102965784, - 0.018356559080216335, - 0.9998059807502554, - 0.011328056658900904 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8294, - "backend_objective": 1388.37610649331, - "backend_elapsed_sec": 0.09492950000276323, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3625, - "objective": 686.63801051527 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6272, - "objective": 614.408796711613 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8294, - "objective": 1388.37610649331 - } - ], - "heldout_symmetric": { - "evaluated": 7656, - "inliers": 6497, - "inlier_ratio": 0.8486154649947754, - "inlier_rmse_m": 0.09691837979566219, - "median_m": 0.07300221130643356, - "p90_m": 0.3683419403600522, - "p95_m": 0.8916022822197027 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42380.21547052753, - 120362.11332860327, - 176105.48439532646, - 608834.6954812828, - 782493.1514649914, - 956853.5010289343 - ], - "effective_rank": 6, - "scaled_condition_number": 22.577834737399076, - "weakest_scaled_direction": [ - 0.04676380706910309, - -0.5544952304469927, - 0.014363011118584497, - 0.03643133198234707, - 0.10173505799558734, - 0.8236896416103426 - ] - }, - "forward_reverse": { - "translation_m": 0.007052114296262031, - "rotation_deg": 0.2907164943632002 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6870704146010145e-06, - "rotation_deg": 3.2896585380997023e-06 - }, - { - "translation_m": 1.6870704142923271e-06, - "rotation_deg": 3.2896585381513404e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 4392, - "frame_counter_j": 6461, - "rtk_translation_m": 2.680593454060616, - "rtk_rotation_deg": 53.0183196584053, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6039219274991686, - 0.796476506619931, - -0.03005794218172748, - -3.15725821264627 - ], - [ - -0.7970407867564487, - 0.6035882908542857, - -0.020178190956167148, - -0.7753386908484848 - ], - [ - 0.0020711669053879236, - 0.03614345786049868, - 0.9993444654980267, - -0.06312326991614099 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7078, - "backend_objective": 1076.1302999208415, - "backend_elapsed_sec": 0.080632199998945, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3564, - "objective": 772.6914060988815 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5673, - "objective": 476.65840307503066 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7078, - "objective": 1076.1302999208415 - } - ], - "heldout_symmetric": { - "evaluated": 7919, - "inliers": 5514, - "inlier_ratio": 0.6963000378835712, - "inlier_rmse_m": 0.10535088240045436, - "median_m": 0.11590530082807096, - "p90_m": 1.012195503647228, - "p95_m": 1.5308493917280512 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18695.287836573658, - 71805.1503985703, - 107984.88478429375, - 388960.2550960267, - 452912.59020250203, - 739035.4133024226 - ], - "effective_rank": 6, - "scaled_condition_number": 39.530571540955094, - "weakest_scaled_direction": [ - 0.3153981679629218, - -0.5492206265876471, - 0.041451906516287704, - 0.047000421720814756, - 0.09490462618277606, - 0.765471430368007 - ] - }, - "forward_reverse": { - "translation_m": 0.0034527207661208545, - "rotation_deg": 0.020238883727394828 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.3114448997918724e-15, - "rotation_deg": 1.4747670495222658e-14 - }, - { - "translation_m": 1.064157877724814e-06, - "rotation_deg": 2.484571306483632e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 4392, - "frame_counter_j": 7268, - "rtk_translation_m": 3.2944321799753977, - "rtk_rotation_deg": 73.22024906015783, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2877343154567465, - 0.9575313472806006, - -0.018511690458591766, - -4.167779016399161 - ], - [ - -0.9575632300755412, - 0.2872976927195431, - -0.02308021155282856, - -0.7429215848471982 - ], - [ - -0.01678166010660944, - 0.02436708298143774, - 0.9995622147475569, - -0.12755868608262347 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6843, - "backend_objective": 730.8749417255324, - "backend_elapsed_sec": 0.08527039999898989, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3528, - "objective": 844.6423575536897 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5533, - "objective": 502.710444430084 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6843, - "objective": 730.8749417255324 - } - ], - "heldout_symmetric": { - "evaluated": 8007, - "inliers": 5272, - "inlier_ratio": 0.6584238791057825, - "inlier_rmse_m": 0.10587631557960675, - "median_m": 0.12670471938214903, - "p90_m": 1.2067667197359873, - "p95_m": 1.850558263049219 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20640.328824007658, - 57341.086635991654, - 100706.09447248589, - 340897.8402861512, - 471416.7130866885, - 691416.2649746807 - ], - "effective_rank": 6, - "scaled_condition_number": 33.498316372288826, - "weakest_scaled_direction": [ - 0.49250018326709594, - -0.46130344582574223, - 0.0600820532241997, - 0.028323741573689942, - 0.10365566574233075, - 0.7276579662549701 - ] - }, - "forward_reverse": { - "translation_m": 0.009482405807021465, - "rotation_deg": 0.07225186033919398 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2867685467013295e-06, - "rotation_deg": 3.119428213922835e-06 - }, - { - "translation_m": 1.3954474889861466e-06, - "rotation_deg": 3.0247570814666316e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 13, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 4392, - "frame_counter_j": 7942, - "rtk_translation_m": 4.1147924441994315, - "rtk_rotation_deg": 94.16944247805917, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07231331385464022, - 0.9968946202347224, - -0.031175323357246085, - -4.935911903546747 - ], - [ - -0.997065659870328, - -0.0730421989422889, - -0.022910850726723327, - 0.7785547856070933 - ], - [ - -0.025116818005221423, - 0.029427084815585064, - 0.9992513158022605, - -0.20064989227173718 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6628, - "backend_objective": 775.2870732128134, - "backend_elapsed_sec": 0.08647970000311034, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3445, - "objective": 878.6688095241398 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5390, - "objective": 549.655866234512 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6628, - "objective": 775.2870732128134 - } - ], - "heldout_symmetric": { - "evaluated": 7988, - "inliers": 4965, - "inlier_ratio": 0.621557336004006, - "inlier_rmse_m": 0.11335203160746431, - "median_m": 0.15309395963392322, - "p90_m": 1.472254577325208, - "p95_m": 2.116669112433769 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20717.288068229078, - 33218.78796584843, - 62970.49033153109, - 233143.95202311708, - 427064.1115525759, - 677405.2778011315 - ], - "effective_rank": 6, - "scaled_condition_number": 32.6975845279655, - "weakest_scaled_direction": [ - 0.6587230539890699, - 0.1461651316784715, - 0.032150023201013934, - -0.07304341486416241, - 0.1067908235807235, - 0.7259107713602522 - ] - }, - "forward_reverse": { - "translation_m": 0.009011781776631502, - "rotation_deg": 0.0416830306778097 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.230544129253696e-06, - "rotation_deg": 8.60181616402537e-06 - }, - { - "translation_m": 6.230544130736518e-06, - "rotation_deg": 8.601816316198729e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 14, - "lidar_time_i": 1784281119.375541, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 4392, - "frame_counter_j": 9502, - "rtk_translation_m": 3.748520283907519, - "rtk_rotation_deg": 169.69584626488452, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9869390143765366, - 0.16067937119987646, - -0.011555153494569174, - -3.5205360649398876 - ], - [ - -0.16079386605880866, - -0.986939650670518, - 0.009770290283190854, - 1.0108286972263762 - ], - [ - -0.00983435505423095, - 0.01150067846555976, - 0.9998855033730112, - -0.22535123731591933 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 25, - "backend_num_inliers": 607, - "backend_objective": 45.015829213036376, - "backend_elapsed_sec": 0.18039929999940796, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 1633, - "objective": 1397.6857787663512 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 27, - "num_inliers": 1069, - "objective": 308.72584827335425 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 25, - "num_inliers": 607, - "objective": 45.015829213036376 - } - ], - "heldout_symmetric": { - "evaluated": 7977, - "inliers": 390, - "inlier_ratio": 0.048890560361037984, - "inlier_rmse_m": 0.15557197380465354, - "median_m": 1.2660146589914476, - "p90_m": 2.7411908450059776, - "p95_m": 3.215397801411571 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 282.86427985487006, - 1139.8471396765926, - 2135.732147756342, - 2356.084028442604, - 5590.291186875345, - 14579.13001807421 - ], - "effective_rank": 6, - "scaled_condition_number": 51.54107837707314, - "weakest_scaled_direction": [ - 0.9804430456803234, - 0.01712810680103255, - 0.0415911194664392, - 0.022186596949522585, - 0.0866764279867136, - -0.1694201660467125 - ] - }, - "forward_reverse": { - "translation_m": 1.0864076801076206, - "rotation_deg": 7.184564913859941 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 8.308148362110449e-16, - "rotation_deg": 4.8939553850662355e-15 - }, - { - "translation_m": 0.10326280330056975, - "rotation_deg": 1.8123491440567112 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281326.268232, - "frame_counter_i": 5391, - "frame_counter_j": 6461, - "rtk_translation_m": 2.249454986440387, - "rtk_rotation_deg": 36.91969015817989, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8026470695932169, - 0.5953414206597143, - -0.03641805212108848, - -2.4730093943804796 - ], - [ - -0.5958359370675957, - 0.8030984663038816, - -0.0035198748746086733, - -0.8956221571641458 - ], - [ - 0.027151754495827015, - 0.024524401465184725, - 0.9993304438275521, - -0.05341548894953125 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 15, - "backend_num_inliers": 7210, - "backend_objective": 1084.2813397000082, - "backend_elapsed_sec": 0.11760700000013458, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3710, - "objective": 660.3878067010464 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6045, - "objective": 611.2694314138973 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 15, - "num_inliers": 7210, - "objective": 1084.2813397000082 - } - ], - "heldout_symmetric": { - "evaluated": 8039, - "inliers": 5753, - "inlier_ratio": 0.7156362731683045, - "inlier_rmse_m": 0.10422606491110974, - "median_m": 0.10748418411287138, - "p90_m": 0.8527421409673256, - "p95_m": 1.422269325772597 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 19035.072699760844, - 90323.4921481537, - 142251.56415585868, - 390569.5373672696, - 460516.1217398476, - 865192.5306850255 - ], - "effective_rank": 6, - "scaled_condition_number": 45.45254669271086, - "weakest_scaled_direction": [ - 0.25346298427713315, - -0.597978290261599, - 0.03264189531326547, - 0.04499105226655155, - 0.09937727597122759, - 0.7518064570645755 - ] - }, - "forward_reverse": { - "translation_m": 0.004301999273657816, - "rotation_deg": 0.02361974788713562 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.390148669251418e-15, - "rotation_deg": 2.92436575694043e-14 - }, - { - "translation_m": 7.219494791688092e-15, - "rotation_deg": 3.6039268143862256e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 5391, - "frame_counter_j": 7268, - "rtk_translation_m": 2.8783779741216167, - "rtk_rotation_deg": 57.12161955993242, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.544347078819777, - 0.8387069301707338, - -0.01602944365720646, - -3.4565245101960773 - ], - [ - -0.8388534292914914, - 0.5443195369306294, - -0.006416064333332386, - -1.1541418015714768 - ], - [ - 0.0033439417279590984, - 0.01693891965885164, - 0.9998509344169815, - -0.15426693296263252 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7374, - "backend_objective": 816.7363973152893, - "backend_elapsed_sec": 0.09428330000082497, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3729, - "objective": 818.0124695654707 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5931, - "objective": 507.96164333612376 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7374, - "objective": 816.7363973152893 - } - ], - "heldout_symmetric": { - "evaluated": 8127, - "inliers": 5631, - "inlier_ratio": 0.692875599852344, - "inlier_rmse_m": 0.10691573133186853, - "median_m": 0.12015250487071094, - "p90_m": 1.0539458621433888, - "p95_m": 1.6837917639088673 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21028.84709112706, - 92136.78059070179, - 140159.46382398932, - 396588.16526324226, - 619876.7035208143, - 822440.3509779369 - ], - "effective_rank": 6, - "scaled_condition_number": 39.11010182412513, - "weakest_scaled_direction": [ - 0.5059793443096311, - -0.4510970346321753, - 0.046321644762583804, - 0.043440231262611324, - 0.10855414574529404, - 0.7243477186088895 - ] - }, - "forward_reverse": { - "translation_m": 0.004231594662123499, - "rotation_deg": 0.01872424915403812 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3626908269611587e-15, - "rotation_deg": 6.397214631049945e-15 - }, - { - "translation_m": 2.6918973635257668e-15, - "rotation_deg": 9.595632359942568e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 5391, - "frame_counter_j": 7942, - "rtk_translation_m": 3.84803303865234, - "rtk_rotation_deg": 78.07081297783375, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.20901981231429378, - 0.977744517585607, - -0.01806589027381743, - -4.626165275692513 - ], - [ - -0.9779074184657942, - 0.20893053237578268, - -0.006716662172365459, - 0.09791990613430666 - ], - [ - -0.002792663542753814, - 0.01907068358660145, - 0.9998142377751361, - -0.14776806343018095 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7059, - "backend_objective": 1283.5668124293757, - "backend_elapsed_sec": 0.13993570000457112, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3568, - "objective": 842.611947918059 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5648, - "objective": 625.9346701322002 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7059, - "objective": 1283.5668124293757 - } - ], - "heldout_symmetric": { - "evaluated": 8108, - "inliers": 5347, - "inlier_ratio": 0.6594721262950173, - "inlier_rmse_m": 0.10871022234744057, - "median_m": 0.12789094100666226, - "p90_m": 1.328257568875001, - "p95_m": 2.1192976058642032 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16861.899905295864, - 61323.79579228367, - 82433.52958680302, - 309065.6291981343, - 570413.3771800441, - 727531.3016214758 - ], - "effective_rank": 6, - "scaled_condition_number": 43.1464607017966, - "weakest_scaled_direction": [ - 0.6694895105213565, - 0.05986106701325278, - 0.019749638042974495, - -0.06198812678862881, - 0.10985494594795474, - 0.7293145842111537 - ] - }, - "forward_reverse": { - "translation_m": 0.006980776690426113, - "rotation_deg": 0.21408921607631748 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2567637595793301e-15, - "rotation_deg": 2.0855747774929756e-15 - }, - { - "translation_m": 2.4121814915098567e-15, - "rotation_deg": 1.0808124357002272e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 14, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 5391, - "frame_counter_j": 9502, - "rtk_translation_m": 3.3834992499807997, - "rtk_rotation_deg": 153.59721676465847, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8884294056385886, - 0.45873632184786506, - -0.015942967545453317, - -3.024049570318905 - ], - [ - -0.4587146727309669, - -0.8885683747037764, - -0.005205045399294303, - 0.24015033352950257 - ], - [ - -0.016554160141341926, - 0.0026889577495562192, - 0.9998593547535758, - -0.43025137703988037 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 558, - "backend_objective": 40.271129997452874, - "backend_elapsed_sec": 0.29666439999709837, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 1510, - "objective": 1477.0664321600964 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 876, - "objective": 268.5887233906003 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 558, - "objective": 40.271129997452874 - } - ], - "heldout_symmetric": { - "evaluated": 8097, - "inliers": 504, - "inlier_ratio": 0.062245276028158575, - "inlier_rmse_m": 0.15570919185507412, - "median_m": 1.4547472527668306, - "p90_m": 3.001358562079382, - "p95_m": 3.3237584391696235 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 258.81703690480117, - 1506.411971662197, - 1934.0430596610079, - 2983.0920123563906, - 3898.345374415944, - 15376.434180940305 - ], - "effective_rank": 6, - "scaled_condition_number": 59.4104405367878, - "weakest_scaled_direction": [ - 0.871925318713812, - 0.47516739319160756, - 0.08776831468758561, - -0.056101777841250915, - 0.055467214981364345, - 0.00590665349184381 - ] - }, - "forward_reverse": { - "translation_m": 0.09444016841800375, - "rotation_deg": 2.8556589503073977 - }, - "multistart": { - "runs": 2, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 0.06756923306348955, - "rotation_deg": 1.6002837216751182 - }, - { - "translation_m": 2.8345732486509614, - "rotation_deg": 1.4823895713911923 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 10, - "j": 15, - "lidar_time_i": 1784281219.2718523, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 5391, - "frame_counter_j": 11146, - "rtk_translation_m": 1.4957886147833104, - "rtk_rotation_deg": 171.72980583515965, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9883953338697574, - -0.1373668148582435, - -0.06484614221518019, - -3.7940371904447465 - ], - [ - 0.1382917121755084, - -0.9903413037704701, - -0.009975188708620037, - 1.0226715879866788 - ], - [ - -0.06284955312535377, - -0.0188271140089841, - 0.9978454156080672, - -0.11948097865284024 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6809, - "backend_objective": 733.276656350816, - "backend_elapsed_sec": 0.15036289999989094, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 19, - "num_inliers": 3539, - "objective": 920.2359685782657 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5464, - "objective": 510.5433466469367 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6809, - "objective": 733.276656350816 - } - ], - "heldout_symmetric": { - "evaluated": 8223, - "inliers": 5125, - "inlier_ratio": 0.6232518545542989, - "inlier_rmse_m": 0.10969245891269987, - "median_m": 0.14618571169301486, - "p90_m": 1.5915621480453095, - "p95_m": 2.634814179731857 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 17404.91836742293, - 53846.12119132127, - 82786.06544160016, - 317970.1972075296, - 541900.3627213852, - 748436.9645858805 - ], - "effective_rank": 6, - "scaled_condition_number": 43.00146365447724, - "weakest_scaled_direction": [ - -0.010924614771477692, - 0.6889614623303677, - 0.03590059664515939, - -0.15130628791335873, - -0.03345263609131557, - 0.707044009770707 - ] - }, - "forward_reverse": { - "translation_m": 3.0001452916434883, - "rotation_deg": 4.8522273147326915 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.987869494273747e-16, - "rotation_deg": 3.676140599956921e-14 - }, - { - "translation_m": 1.7244233337941968e-15, - "rotation_deg": 1.480446518911716e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281406.9641902, - "frame_counter_i": 6461, - "frame_counter_j": 7268, - "rtk_translation_m": 0.636223282239137, - "rtk_rotation_deg": 20.20192940175253, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9371956147696628, - 0.3487131962537873, - 0.007967836279795451, - -0.6321966537462228 - ], - [ - -0.34877681134194793, - 0.937163784880924, - 0.008875594504296473, - -0.7881260545066597 - ], - [ - -0.004372130677038871, - -0.011097164778862122, - 0.9999288661735963, - -0.026946457018436835 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9898, - "backend_objective": 2162.272264865104, - "backend_elapsed_sec": 0.11801720000221394, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4249, - "objective": 699.2138178751973 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7262, - "objective": 909.9662569308975 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9898, - "objective": 2162.272264865104 - } - ], - "heldout_symmetric": { - "evaluated": 8390, - "inliers": 7290, - "inlier_ratio": 0.8688915375446961, - "inlier_rmse_m": 0.08660981428891965, - "median_m": 0.07021885648152525, - "p90_m": 0.35442195794095555, - "p95_m": 0.6130784085298314 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 80285.56395096118, - 154032.68321755665, - 543504.0634545566, - 705335.0933223908, - 1245244.7859198009, - 1447813.4695750407 - ], - "effective_rank": 6, - "scaled_condition_number": 18.033297623211222, - "weakest_scaled_direction": [ - 0.5573028088385298, - -0.342029904451023, - 0.03350163875971613, - 0.08481278531500487, - 0.1221569965466927, - 0.7410743711424146 - ] - }, - "forward_reverse": { - "translation_m": 0.005089530929434581, - "rotation_deg": 0.03170796903435614 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.947248820392849e-16, - "rotation_deg": 3.2703203524364657e-15 - }, - { - "translation_m": 7.494005416219807e-16, - "rotation_deg": 8.980786819236643e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 6461, - "frame_counter_j": 7942, - "rtk_translation_m": 2.0145868546459504, - "rtk_rotation_deg": 41.151122819653864, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7514963762844198, - 0.6597274483359195, - -0.0035903124602662375, - -2.313964787858916 - ], - [ - -0.6596062455886907, - 0.751444494344757, - 0.015835804347805123, - -0.499123557240481 - ], - [ - 0.013145235325968814, - -0.00953235706051812, - 0.9998681597876291, - -0.1413342437685064 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8897, - "backend_objective": 2275.762331051696, - "backend_elapsed_sec": 0.3507017000010819, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4103, - "objective": 787.4288122334265 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 6813, - "objective": 1206.2734648460878 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8897, - "objective": 2275.762331051696 - } - ], - "heldout_symmetric": { - "evaluated": 8371, - "inliers": 6715, - "inlier_ratio": 0.8021741727392188, - "inlier_rmse_m": 0.10650327571539893, - "median_m": 0.09780819654817584, - "p90_m": 0.5189921451409358, - "p95_m": 0.9712061210582154 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 55070.39301277661, - 75306.89277558721, - 302445.544589093, - 522093.20400236215, - 838433.9313589357, - 1009975.8085801422 - ], - "effective_rank": 6, - "scaled_condition_number": 18.339724002801702, - "weakest_scaled_direction": [ - -0.6911400981924295, - 0.008344189481964137, - -0.012120028334159096, - 0.001665891862053834, - -0.13767819482769567, - -0.709331222743591 - ] - }, - "forward_reverse": { - "translation_m": 0.04485533499047456, - "rotation_deg": 0.27313934813876123 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0778315928076987e-15, - "rotation_deg": 7.683301954634173e-15 - }, - { - "translation_m": 7.882545766750268e-06, - "rotation_deg": 3.973270060056488e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 6461, - "frame_counter_j": 9502, - "rtk_translation_m": 1.2405786051647103, - "rtk_rotation_deg": 116.67752660647822, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4594726595275172, - 0.8881902134521932, - -0.001737778598919235, - -3.0935540456129584 - ], - [ - -0.8881882778758939, - -0.45947549740021587, - -0.001962226459620987, - -1.4237343334942592 - ], - [ - -0.00254129702412217, - 0.0006418851711063395, - 0.9999965648905308, - -0.03882597459795958 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 23, - "backend_num_inliers": 8223, - "backend_objective": 2707.224263888237, - "backend_elapsed_sec": 0.22237899999890942, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3994, - "objective": 762.8025592428319 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6475, - "objective": 799.3786095755967 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 23, - "num_inliers": 8223, - "objective": 2707.224263888237 - } - ], - "heldout_symmetric": { - "evaluated": 8360, - "inliers": 6233, - "inlier_ratio": 0.7455741626794259, - "inlier_rmse_m": 0.11063741423489376, - "median_m": 0.10908654247803001, - "p90_m": 0.8145914641388259, - "p95_m": 1.3029631164404543 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40859.7146109918, - 78460.53527308247, - 259977.980791899, - 479910.38642532437, - 645537.7886738732, - 845590.2094438885 - ], - "effective_rank": 6, - "scaled_condition_number": 20.694961222671232, - "weakest_scaled_direction": [ - 0.06728960920612632, - 0.7356712780031167, - 0.007951428740547538, - -0.15416880559091517, - -0.10493687917351309, - 0.6476240304120331 - ] - }, - "forward_reverse": { - "translation_m": 0.007044503253911164, - "rotation_deg": 0.40985193451245056 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.105954299835844e-15, - "rotation_deg": 2.8669265819056474e-14 - }, - { - "translation_m": 1.099152334353211e-15, - "rotation_deg": 1.9362482169472626e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 15, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 6461, - "frame_counter_j": 11146, - "rtk_translation_m": 1.4202907399288436, - "rtk_rotation_deg": 151.3505040066613, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8753441704067417, - 0.4813761764981961, - -0.04527206682835245, - -2.1926618120662797 - ], - [ - -0.48131846884403645, - -0.8764510796939674, - -0.01288551329638342, - 0.7422080329800284 - ], - [ - -0.0458815309745167, - 0.010511022940539731, - 0.9988915874669172, - -0.11155782873731296 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8387, - "backend_objective": 1759.4732917432189, - "backend_elapsed_sec": 0.1327515000011772, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3962, - "objective": 717.3310078419488 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6310, - "objective": 861.2061325307943 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8387, - "objective": 1759.4732917432189 - } - ], - "heldout_symmetric": { - "evaluated": 8486, - "inliers": 6336, - "inlier_ratio": 0.7466415272213057, - "inlier_rmse_m": 0.10329430650455694, - "median_m": 0.09879655188222494, - "p90_m": 0.858818613514028, - "p95_m": 1.5542556798204363 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33022.70959526503, - 69004.00666568193, - 294990.41598090605, - 559478.47742423, - 666980.7185574444, - 914868.2202658961 - ], - "effective_rank": 6, - "scaled_condition_number": 27.704214205277534, - "weakest_scaled_direction": [ - -0.052697587381587356, - 0.6680105259118909, - 0.019045649844067213, - -0.17966327715223096, - 0.017134269418162366, - 0.7197566869654786 - ] - }, - "forward_reverse": { - "translation_m": 0.13203399207663835, - "rotation_deg": 1.4478079414864902 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 5.900916318210353e-16, - "rotation_deg": 1.6184594838496324e-14 - }, - { - "translation_m": 2.343197092906056, - "rotation_deg": 1.66893631718337 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 11, - "j": 16, - "lidar_time_i": 1784281326.268232, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 6461, - "frame_counter_j": 12282, - "rtk_translation_m": 2.7368971716016928, - "rtk_rotation_deg": 176.81389445065594, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9977763254945377, - 0.0563486088708824, - -0.03559829435429065, - -0.7385145758714027 - ], - [ - -0.05612163031387543, - -0.9983969271537404, - -0.007344280827993945, - 1.9148462112829492 - ], - [ - -0.035955067703052686, - -0.005330115222399747, - 0.9993391931562505, - -0.059540896185619405 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8594, - "backend_objective": 1814.1165377748011, - "backend_elapsed_sec": 0.1268398000029265, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3925, - "objective": 850.0328525382836 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6621, - "objective": 775.1058296522554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8594, - "objective": 1814.1165377748011 - } - ], - "heldout_symmetric": { - "evaluated": 8277, - "inliers": 6509, - "inlier_ratio": 0.78639603721155, - "inlier_rmse_m": 0.10318237166131629, - "median_m": 0.09493949257822674, - "p90_m": 0.6364631557249012, - "p95_m": 1.3221726709674442 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 28166.190880798276, - 115006.28609738474, - 258947.696313962, - 575213.4866814459, - 797073.5527920969, - 976203.3766407112 - ], - "effective_rank": 6, - "scaled_condition_number": 34.658693494341755, - "weakest_scaled_direction": [ - 0.27745507489777643, - -0.5920675965441212, - -0.028588174303706523, - 0.10070930713422885, - 0.08779464107497928, - -0.7441821653875995 - ] - }, - "forward_reverse": { - "translation_m": 0.008767229441137649, - "rotation_deg": 0.032548654712657686 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.42861286636753e-16, - "rotation_deg": 7.001528258603851e-15 - }, - { - "translation_m": 1.8901450195916007e-15, - "rotation_deg": 4.461008645244417e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281474.3615055, - "frame_counter_i": 7268, - "frame_counter_j": 7942, - "rtk_translation_m": 1.5928240921286525, - "rtk_rotation_deg": 20.949193417901323, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9334731566007374, - 0.35817264208365196, - 0.018445171961015173, - -1.6869303033738752 - ], - [ - -0.358419320891895, - 0.9334786529917025, - 0.012377189510925219, - -0.3291261821471906 - ], - [ - -0.012785003607670615, - -0.01816488017061019, - 0.9997532599652476, - -0.08954638566145792 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 15, - "backend_num_inliers": 9469, - "backend_objective": 1950.1305013280225, - "backend_elapsed_sec": 0.17725849999987986, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 2, - "num_inliers": 4298, - "objective": 713.0228353837309 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7398, - "objective": 1102.7170640528957 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 15, - "num_inliers": 9469, - "objective": 1950.1305013280225 - } - ], - "heldout_symmetric": { - "evaluated": 8459, - "inliers": 6951, - "inlier_ratio": 0.8217283366828231, - "inlier_rmse_m": 0.10684146627686454, - "median_m": 0.09575107105138746, - "p90_m": 0.4142599959298521, - "p95_m": 0.7001196138421679 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 81357.97014691656, - 90975.93182440297, - 470398.7380323842, - 671324.6973641065, - 880257.542351925, - 1334297.037642465 - ], - "effective_rank": 6, - "scaled_condition_number": 16.400323597466677, - "weakest_scaled_direction": [ - -0.1213960775834498, - 0.12737999775643866, - -0.022361132470899492, - -0.9733802927474433, - -0.10446716191412928, - -0.10077066064113209 - ] - }, - "forward_reverse": { - "translation_m": 0.01763325318199382, - "rotation_deg": 0.09467538550034012 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.130909444985391e-16, - "rotation_deg": 2.0012035402824407e-14 - }, - { - "translation_m": 5.194446892679256e-16, - "rotation_deg": 8.161301462077442e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 7268, - "frame_counter_j": 9502, - "rtk_translation_m": 0.6774809171975742, - "rtk_rotation_deg": 96.47559720472566, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.12090643085695976, - 0.992655020780019, - -0.004200559207002008, - -2.105645886982196 - ], - [ - -0.9926604218634874, - -0.12091613906453468, - -0.002138733160134857, - -1.4585409554445847 - ], - [ - -0.002630939610739252, - 0.003911142281537837, - 0.9999888904996983, - -0.022834872556695533 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 8618, - "backend_objective": 2892.8424209198497, - "backend_elapsed_sec": 0.14285650000238093, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4186, - "objective": 719.3169377552709 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6911, - "objective": 1272.6669810288383 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 8618, - "objective": 2892.8424209198497 - } - ], - "heldout_symmetric": { - "evaluated": 8448, - "inliers": 6430, - "inlier_ratio": 0.7611268939393939, - "inlier_rmse_m": 0.10826784336909262, - "median_m": 0.10233945158433569, - "p90_m": 0.5870826446527403, - "p95_m": 1.0427955306477301 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 85401.75036780712, - 92504.18243397803, - 410950.9942279096, - 559230.8316714325, - 748315.2204326417, - 908302.1864656003 - ], - "effective_rank": 6, - "scaled_condition_number": 10.635638995146312, - "weakest_scaled_direction": [ - 0.0472384354213391, - 0.5593610389819712, - 0.01315903060652493, - -0.22378903912411688, - -0.6128220994683812, - 0.5089971891597445 - ] - }, - "forward_reverse": { - "translation_m": 0.0015931090432955832, - "rotation_deg": 0.024585439481643892 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.265153280995946e-16, - "rotation_deg": 2.3378276163669887e-15 - }, - { - "translation_m": 9.829026491055893e-16, - "rotation_deg": 2.8333611161443553e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 7268, - "frame_counter_j": 11146, - "rtk_translation_m": 1.8892292086221258, - "rtk_rotation_deg": 131.14857460490867, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6528335390665899, - 0.7566596526355762, - -0.035700705079873295, - -2.0069806712782876 - ], - [ - -0.7550046734734494, - -0.6537820999765125, - -0.050367735541222515, - 0.9173028640618776 - ], - [ - -0.06145171521642369, - -0.005927547866544685, - 0.9980924560747114, - 0.05956800602746556 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8584, - "backend_objective": 2426.370963581025, - "backend_elapsed_sec": 0.18129010000120616, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 3665, - "objective": 2833.611336479225 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 14, - "num_inliers": 6580, - "objective": 1084.3525466150913 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8584, - "objective": 2426.370963581025 - } - ], - "heldout_symmetric": { - "evaluated": 8574, - "inliers": 6280, - "inlier_ratio": 0.7324469325868906, - "inlier_rmse_m": 0.11113399174419211, - "median_m": 0.11334760825204335, - "p90_m": 0.7190838999317832, - "p95_m": 1.373254005312545 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43622.707747874585, - 67663.74082132244, - 310605.9405542003, - 661670.120828618, - 727790.1990690583, - 871166.0585201021 - ], - "effective_rank": 6, - "scaled_condition_number": 19.970471882560926, - "weakest_scaled_direction": [ - -0.12014289651724333, - 0.6781502887136084, - 0.030662151928332614, - -0.1798802156579679, - -0.032775294473131975, - 0.7009326578639801 - ] - }, - "forward_reverse": { - "translation_m": 0.0024416100752998565, - "rotation_deg": 0.009279978214820864 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4244856739655695e-15, - "rotation_deg": 1.923087271827943e-14 - }, - { - "translation_m": 2.3890763870554686e-15, - "rotation_deg": 1.581269438804674e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 16, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 7268, - "frame_counter_j": 12282, - "rtk_translation_m": 3.349436875941103, - "rtk_rotation_deg": 156.6119650489076, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9155004437095494, - 0.4009651777715893, - -0.032952447287191974, - -1.0451954377498973 - ], - [ - -0.4003545060280441, - -0.916053821842797, - -0.023699472362172323, - 2.4909499292406596 - ], - [ - -0.03968887842529677, - -0.008504216707172054, - 0.9991758960401015, - -0.03319354735749507 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8354, - "backend_objective": 1967.2919517341786, - "backend_elapsed_sec": 0.11182600000029197, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 3944, - "objective": 817.5704973091188 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6541, - "objective": 928.4735042646357 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8354, - "objective": 1967.2919517341786 - } - ], - "heldout_symmetric": { - "evaluated": 8365, - "inliers": 6274, - "inlier_ratio": 0.7500298864315601, - "inlier_rmse_m": 0.10525785108693746, - "median_m": 0.10018309817258013, - "p90_m": 0.830984498758739, - "p95_m": 1.56967073636776 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 30172.361763520803, - 105927.52065621327, - 213524.03097699044, - 619852.8503642206, - 791171.8025998115, - 926541.3448937718 - ], - "effective_rank": 6, - "scaled_condition_number": 30.70828038440084, - "weakest_scaled_direction": [ - -0.30372863395871585, - 0.5760729343622365, - 0.03701686078751122, - -0.09585122468870613, - -0.09888525691364874, - 0.7453542056747845 - ] - }, - "forward_reverse": { - "translation_m": 0.0024719134275639418, - "rotation_deg": 0.013160987022490347 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.626946465381911e-15, - "rotation_deg": 1.0095014781658578e-14 - }, - { - "translation_m": 1.2381016884676358e-15, - "rotation_deg": 1.6016158730824006e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 17, - "lidar_time_i": 1784281406.9641902, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 7268, - "frame_counter_j": 13524, - "rtk_translation_m": 6.51378754358264, - "rtk_rotation_deg": 111.73754176984298, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.37087310069518786, - 0.9285572704328996, - -0.015314656605359727, - -3.8827370344848955 - ], - [ - -0.9282241242868864, - -0.370120566693206, - 0.03755983496426634, - -7.3759706362269215 - ], - [ - 0.02920818845084177, - 0.028145366171061396, - 0.999177021398369, - 0.3512216667086923 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 6260, - "backend_objective": 272.3307319422028, - "backend_elapsed_sec": 0.08572129999811295, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3030, - "objective": 739.4380756364866 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4688, - "objective": 402.2947086598857 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 6260, - "objective": 272.3307319422028 - } - ], - "heldout_symmetric": { - "evaluated": 8557, - "inliers": 5304, - "inlier_ratio": 0.6198434030618207, - "inlier_rmse_m": 0.1221546776649581, - "median_m": 0.1614291311529053, - "p90_m": 1.4365512914299023, - "p95_m": 2.174620387702925 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 23846.713492270108, - 39763.12544049202, - 75591.8459784553, - 85305.64066106586, - 281185.1753172214, - 561389.8991349357 - ], - "effective_rank": 6, - "scaled_condition_number": 23.54160456185754, - "weakest_scaled_direction": [ - 0.22513441639115397, - 0.917993721071173, - -0.006870133447605462, - -0.068055887195187, - 0.07980219413415858, - -0.3091194428145497 - ] - }, - "forward_reverse": { - "translation_m": 0.013538123192296372, - "rotation_deg": 0.06236055877935909 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1670688905509757e-15, - "rotation_deg": 2.4561468303717916e-14 - }, - { - "translation_m": 2.482534153247273e-16, - "rotation_deg": 1.0506156369790924e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281630.3553114, - "frame_counter_i": 7942, - "frame_counter_j": 9502, - "rtk_translation_m": 0.9721300146850552, - "rtk_rotation_deg": 75.52640378682433, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.24055323851553503, - 0.9706352271826483, - 0.00118118236452118, - 0.007908243805650843 - ], - [ - -0.9705121883465464, - 0.24050295744035147, - 0.016260988077071985, - -1.2506315676678772 - ], - [ - 0.015499410004459351, - -0.00505798522482996, - 0.9998670837041184, - -0.02549886304005046 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 9718, - "backend_objective": 3164.6516243944243, - "backend_elapsed_sec": 0.11082829999941168, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4384, - "objective": 620.0538828655934 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7510, - "objective": 1022.7625821958271 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 9718, - "objective": 3164.6516243944243 - } - ], - "heldout_symmetric": { - "evaluated": 8429, - "inliers": 6978, - "inlier_ratio": 0.8278562107011508, - "inlier_rmse_m": 0.10919246415865995, - "median_m": 0.10056803413400761, - "p90_m": 0.40512041852515757, - "p95_m": 0.604049129120264 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 89486.16909802526, - 146862.85039687649, - 659769.6048001102, - 803440.9588148856, - 862801.975727927, - 1138568.5358483512 - ], - "effective_rank": 6, - "scaled_condition_number": 12.723402368483741, - "weakest_scaled_direction": [ - -0.09785364300744967, - -0.0025667226541201127, - 0.0017315837747209778, - -0.16138919106505006, - -0.9820200522524332, - -0.002285625541262237 - ] - }, - "forward_reverse": { - "translation_m": 0.0049872211162087675, - "rotation_deg": 0.02566897887278044 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0638028178764803e-15, - "rotation_deg": 3.89161291449732e-15 - }, - { - "translation_m": 2.2729511820139823e-16, - "rotation_deg": 2.978479745353383e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 7942, - "frame_counter_j": 11146, - "rtk_translation_m": 2.426469315960194, - "rtk_rotation_deg": 110.19938118700728, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3408805934510223, - 0.9400140163370704, - -0.013193562761050541, - -0.737444114442546 - ], - [ - -0.9389231942803244, - -0.34112191395268493, - -0.04537703233674287, - 1.0091066265185293 - ], - [ - -0.04715565979722318, - -0.0030804076204516253, - 0.998882803354818, - 0.05481538440009388 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9360, - "backend_objective": 2442.475929330756, - "backend_elapsed_sec": 0.09862550000252668, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4133, - "objective": 647.2936613387276 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7020, - "objective": 828.6805748102338 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9360, - "objective": 2442.475929330756 - } - ], - "heldout_symmetric": { - "evaluated": 8555, - "inliers": 6747, - "inlier_ratio": 0.7886616014026885, - "inlier_rmse_m": 0.10800229196760061, - "median_m": 0.09595584568547873, - "p90_m": 0.5518132077889158, - "p95_m": 1.055039761045908 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 85572.01209020732, - 95946.31409428312, - 497692.4749094236, - 823241.7130598151, - 974491.8840410864, - 1169302.2505468337 - ], - "effective_rank": 6, - "scaled_condition_number": 13.66454080002457, - "weakest_scaled_direction": [ - -0.07395538849744229, - -0.10596211380567203, - -0.006608142610902555, - 0.4271629155110631, - -0.8938239782769738, - -0.043237748212324845 - ] - }, - "forward_reverse": { - "translation_m": 0.0038816141140735755, - "rotation_deg": 0.020030260506224723 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.552849575635886e-16, - "rotation_deg": 6.610944726719669e-15 - }, - { - "translation_m": 4.579669976578771e-16, - "rotation_deg": 1.5664633135204343e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 7942, - "frame_counter_j": 12282, - "rtk_translation_m": 4.157137927296689, - "rtk_rotation_deg": 135.66277163100625, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7114929145680909, - 0.7021918163370885, - -0.02654214740037605, - -0.40118889039205835 - ], - [ - -0.7010743274789456, - -0.7119096573774671, - -0.04098081359173361, - 2.84965046337485 - ], - [ - -0.04767200299281505, - -0.010549540365188499, - 0.9988073324364092, - 0.058866406418681315 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 15, - "backend_num_inliers": 8332, - "backend_objective": 2303.2281067089802, - "backend_elapsed_sec": 0.16532379999989644, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 4031, - "objective": 863.0474326100314 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 6603, - "objective": 797.268170877505 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 15, - "num_inliers": 8332, - "objective": 2303.2281067089802 - } - ], - "heldout_symmetric": { - "evaluated": 8346, - "inliers": 6241, - "inlier_ratio": 0.7477833692786964, - "inlier_rmse_m": 0.10901310110319071, - "median_m": 0.10774463513543406, - "p90_m": 0.7582286047203066, - "p95_m": 1.5081779419223271 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43227.013849733776, - 86629.12306411313, - 139126.9530116621, - 610909.4509485151, - 740421.889386766, - 909252.8770780354 - ], - "effective_rank": 6, - "scaled_condition_number": 21.034367079780026, - "weakest_scaled_direction": [ - -0.3497287915517159, - 0.528338738094593, - 0.025722182093465426, - -0.06870650513846213, - -0.13053968980052336, - 0.7590290673453699 - ] - }, - "forward_reverse": { - "translation_m": 0.0024107551433002806, - "rotation_deg": 0.01470679715840447 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.152099519469425e-16, - "rotation_deg": 6.599762106034908e-15 - }, - { - "translation_m": 2.785125417689954e-15, - "rotation_deg": 2.2606693051038843e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 17, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 7942, - "frame_counter_j": 13524, - "rtk_translation_m": 6.347445048137873, - "rtk_rotation_deg": 90.78834835194164, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.014905774252490166, - 0.9994623915748678, - -0.02920181024138763, - 0.46531730676069866 - ], - [ - -0.9994232512220635, - -0.014001273396657197, - 0.030937505716986308, - -7.390086155835096 - ], - [ - 0.03051201092439331, - 0.029646115609169923, - 0.9990946526824389, - 0.4237905341885188 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6391, - "backend_objective": 298.36415978125757, - "backend_elapsed_sec": 0.22874079999746755, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3144, - "objective": 1036.8744855435712 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 4870, - "objective": 413.8226538814803 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6391, - "objective": 298.36415978125757 - } - ], - "heldout_symmetric": { - "evaluated": 8538, - "inliers": 5227, - "inlier_ratio": 0.6122042632935114, - "inlier_rmse_m": 0.12126385638135445, - "median_m": 0.164703571623297, - "p90_m": 1.4635217425516316, - "p95_m": 2.2767223644475125 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20120.302093799102, - 49801.34373724401, - 75429.94803903025, - 93288.58500775031, - 300067.7116666404, - 554320.2339708018 - ], - "effective_rank": 6, - "scaled_condition_number": 27.550293797111443, - "weakest_scaled_direction": [ - 0.5119060560806822, - 0.408548789826064, - 0.02344138800251451, - -0.02257997137219499, - 0.2064970028739156, - -0.7261815958181645 - ] - }, - "forward_reverse": { - "translation_m": 0.010111269848200304, - "rotation_deg": 1.6132660739833655 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.938893903907228e-16, - "rotation_deg": 6.0533704250381895e-15 - }, - { - "translation_m": 2.482534153247273e-16, - "rotation_deg": 1.3843750168824855e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 13, - "j": 18, - "lidar_time_i": 1784281474.3615055, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 7942, - "frame_counter_j": 14726, - "rtk_translation_m": 4.26917989710959, - "rtk_rotation_deg": 135.79234683500215, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.719047180579757, - 0.6941597213908789, - -0.03336814796838308, - -1.1123195851802798 - ], - [ - -0.694861577293226, - -0.7173016413457756, - 0.05143679348702101, - -5.056277187823842 - ], - [ - 0.011770322929800776, - 0.060171725263570085, - 0.9981186417340042, - 0.22730861509126213 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7356, - "backend_objective": 685.5397260831821, - "backend_elapsed_sec": 0.11728130000119563, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 3690, - "objective": 1256.3884449180657 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5888, - "objective": 593.7997529262564 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7356, - "objective": 685.5397260831821 - } - ], - "heldout_symmetric": { - "evaluated": 8156, - "inliers": 5511, - "inlier_ratio": 0.6756988719960765, - "inlier_rmse_m": 0.1140499722068077, - "median_m": 0.13119289269884277, - "p90_m": 1.2385330818054663, - "p95_m": 2.025049495441565 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 45513.469045206744, - 76706.70890067723, - 103944.50107246292, - 129209.42190077913, - 263336.9395822008, - 622109.6947971842 - ], - "effective_rank": 6, - "scaled_condition_number": 13.668694297489541, - "weakest_scaled_direction": [ - -0.7090907268016854, - 0.49442755837842634, - 0.021174577212284433, - 0.02247204349795697, - -0.0790926180004527, - 0.49550250554214903 - ] - }, - "forward_reverse": { - "translation_m": 0.010188526275029454, - "rotation_deg": 0.05757819838859875 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7792188014569567e-15, - "rotation_deg": 2.889857962021073e-14 - }, - { - "translation_m": 1.3763880263436045e-15, - "rotation_deg": 1.5934744750002238e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784281794.7491786, - "frame_counter_i": 9502, - "frame_counter_j": 11146, - "rtk_translation_m": 2.176233486689304, - "rtk_rotation_deg": 34.672977400182965, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8290527946515831, - 0.5572072061379844, - 0.04681445405323361, - -2.3634699800560033 - ], - [ - -0.5566394949532995, - 0.8303594407165583, - -0.025606090506375467, - -0.18477775142670133 - ], - [ - -0.05314072203626788, - -0.004829973166294462, - 0.9985753527003746, - 0.06615222933064169 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8708, - "backend_objective": 1881.756561612646, - "backend_elapsed_sec": 0.10197540000081062, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3924, - "objective": 684.9892070805153 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6597, - "objective": 770.3204990736106 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8708, - "objective": 1881.756561612646 - } - ], - "heldout_symmetric": { - "evaluated": 8544, - "inliers": 6336, - "inlier_ratio": 0.7415730337078652, - "inlier_rmse_m": 0.11426627617931512, - "median_m": 0.11712763916482276, - "p90_m": 0.6957885693377909, - "p95_m": 1.3931753345819387 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 67920.43585228751, - 69887.49572982028, - 279543.68741538405, - 628033.0896915299, - 764467.4198873412, - 912661.1493606786 - ], - "effective_rank": 6, - "scaled_condition_number": 13.437209845730706, - "weakest_scaled_direction": [ - 0.25969565826261753, - -0.5526317174416979, - -0.013442520265785957, - -0.00046308474005973376, - 0.4147476706451852, - -0.6745070821368786 - ] - }, - "forward_reverse": { - "translation_m": 0.009280638111078932, - "rotation_deg": 0.07287904157175247 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 0.00012826266749592022, - "rotation_deg": 0.000799135485345998 - }, - { - "translation_m": 1.5486019394121221e-15, - "rotation_deg": 1.3936123058757155e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 9502, - "frame_counter_j": 12282, - "rtk_translation_m": 3.79947855245853, - "rtk_rotation_deg": 60.13636784418198, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5090798543856124, - 0.8605365882755138, - 0.017733643107452745, - -4.046728407440868 - ], - [ - -0.8599739632735559, - 0.5093882906554842, - -0.031118352055612364, - 0.5673302965503934 - ], - [ - -0.03581179066029275, - 0.0005912547867964601, - 0.9993583771938273, - 0.0039959329330042665 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8116, - "backend_objective": 1340.6413915787145, - "backend_elapsed_sec": 0.11053770000580698, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3874, - "objective": 887.3960001018577 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6378, - "objective": 570.9752154993206 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8116, - "objective": 1340.6413915787145 - } - ], - "heldout_symmetric": { - "evaluated": 8335, - "inliers": 5943, - "inlier_ratio": 0.7130173965206958, - "inlier_rmse_m": 0.11194096137848975, - "median_m": 0.12002866174377448, - "p90_m": 0.8582575597224169, - "p95_m": 1.6564200634423782 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22159.767697576845, - 67799.48415296727, - 88091.11938133356, - 559973.7269333624, - 676448.0673033217, - 811196.5366376427 - ], - "effective_rank": 6, - "scaled_condition_number": 36.60672565292038, - "weakest_scaled_direction": [ - -0.42603536291462957, - 0.4558644797358401, - 0.017941201444679082, - -0.06395473559867118, - -0.11704118224112185, - 0.7697861471903727 - ] - }, - "forward_reverse": { - "translation_m": 0.0004016408999195087, - "rotation_deg": 0.020284570842973915 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.575673587391975e-16, - "rotation_deg": 3.4743314094827805e-15 - }, - { - "translation_m": 9.43689570931383e-16, - "rotation_deg": 6.117387047332023e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 9502, - "frame_counter_j": 13524, - "rtk_translation_m": 6.190474035537447, - "rtk_rotation_deg": 15.261944565117341, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9660442523653936, - 0.2550637004034034, - -0.04124331713515304, - 6.08119428393812 - ], - [ - -0.25574502503499796, - 0.9666685721160466, - -0.012097679652644066, - -1.0660345158480398 - ], - [ - 0.036782939545869114, - 0.02223466706865058, - 0.9990758904801507, - 0.493119731124628 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6615, - "backend_objective": 407.657713178893, - "backend_elapsed_sec": 0.18718209999497049, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3151, - "objective": 953.6159322461191 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4983, - "objective": 519.9682727155362 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6615, - "objective": 407.657713178893 - } - ], - "heldout_symmetric": { - "evaluated": 8527, - "inliers": 5217, - "inlier_ratio": 0.6118212736015011, - "inlier_rmse_m": 0.11991020962112661, - "median_m": 0.1628273773578813, - "p90_m": 1.607350948519011, - "p95_m": 2.6063509683165824 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33953.43170599871, - 65451.13973053229, - 77819.34369765205, - 124607.1428489892, - 315896.7637424806, - 582379.9370480704 - ], - "effective_rank": 6, - "scaled_condition_number": 17.152314443231333, - "weakest_scaled_direction": [ - -0.42565707689461674, - -0.47774066603255283, - -0.024837681387175663, - 0.03432353607181976, - -0.25399520292742916, - 0.7240658328170114 - ] - }, - "forward_reverse": { - "translation_m": 0.020151321868834806, - "rotation_deg": 0.2079666531947748 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.285864508759251e-15, - "rotation_deg": 7.29095905172244e-14 - }, - { - "translation_m": 8.686031891111346e-15, - "rotation_deg": 7.192649523194445e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 18, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 9502, - "frame_counter_j": 14726, - "rtk_translation_m": 4.170672674565236, - "rtk_rotation_deg": 60.26594304817776, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5012323533771013, - 0.8631598603866406, - -0.06100150281237688, - 3.443525580734251 - ], - [ - -0.8652304627983591, - 0.5009098620115114, - -0.02157675567240608, - -2.020313525287488 - ], - [ - 0.01193206494245182, - 0.063595326533671, - 0.9979044344371283, - 0.22180973978417215 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7546, - "backend_objective": 801.7454405615922, - "backend_elapsed_sec": 0.10277720000158297, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3732, - "objective": 876.8441986574896 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6080, - "objective": 756.261827999846 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7546, - "objective": 801.7454405615922 - } - ], - "heldout_symmetric": { - "evaluated": 8145, - "inliers": 5503, - "inlier_ratio": 0.6756292203806016, - "inlier_rmse_m": 0.1138218459710723, - "median_m": 0.13100859766820297, - "p90_m": 1.2851587314685828, - "p95_m": 2.1313651425047837 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 58205.1809464706, - 69641.71870571708, - 102943.63698573122, - 129184.12586068816, - 259012.32625586778, - 642668.732011874 - ], - "effective_rank": 6, - "scaled_condition_number": 11.041435170572107, - "weakest_scaled_direction": [ - -0.8678163358011179, - -0.07317435953769108, - 0.020186724366409094, - 0.09173469514395835, - -0.12036854863570132, - 0.467149841901401 - ] - }, - "forward_reverse": { - "translation_m": 0.023698120255922432, - "rotation_deg": 0.1321697884270417 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1970346188077032e-15, - "rotation_deg": 2.6406476077672395e-14 - }, - { - "translation_m": 5.721958498152797e-16, - "rotation_deg": 5.4655274305522586e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 19, - "lidar_time_i": 1784281630.3553114, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 9502, - "frame_counter_j": 15687, - "rtk_translation_m": 3.9999134794649294, - "rtk_rotation_deg": 94.30913149027137, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.056133490496129056, - 0.9955996558168776, - -0.07503570204932769, - 1.7801496883385262 - ], - [ - -0.9983375970525242, - -0.05695446985883638, - -0.008844810596665224, - 1.1273849751417202 - ], - [ - -0.013079509016510421, - 0.074414472385507, - 0.9971416212070753, - 0.07756873462467948 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 22, - "backend_num_inliers": 7773, - "backend_objective": 997.558371061591, - "backend_elapsed_sec": 0.1953536000000895, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4111, - "objective": 1064.047846644086 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6687, - "objective": 802.6702672116847 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 22, - "num_inliers": 7773, - "objective": 997.558371061591 - } - ], - "heldout_symmetric": { - "evaluated": 8101, - "inliers": 5427, - "inlier_ratio": 0.6699172941612147, - "inlier_rmse_m": 0.112413086617321, - "median_m": 0.12944642726439298, - "p90_m": 1.2076549140420911, - "p95_m": 2.0572029841898876 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 71699.99283392947, - 87643.69330122818, - 164322.03001683086, - 319996.1009266177, - 503885.74651909544, - 698959.129938531 - ], - "effective_rank": 6, - "scaled_condition_number": 9.748384934395327, - "weakest_scaled_direction": [ - 0.1159337424505285, - -0.392825824106771, - 0.02320624022516457, - 0.903679080304573, - -0.093031065721482, - -0.08011273507669808 - ] - }, - "forward_reverse": { - "translation_m": 0.018186549996561333, - "rotation_deg": 1.2493862686891326 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.720094793600035e-06, - "rotation_deg": 3.152646179044986e-05 - }, - { - "translation_m": 8.720094794269891e-06, - "rotation_deg": 3.1526461799323915e-05 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784281908.3446162, - "frame_counter_i": 11146, - "frame_counter_j": 12282, - "rtk_translation_m": 1.7328875589135755, - "rtk_rotation_deg": 25.463390443999018, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9030296830620778, - 0.4294131609448092, - -0.011904987030229677, - -1.8238306772330162 - ], - [ - -0.4295773517164333, - 0.90273475844995, - -0.023092309945222433, - -0.3113540141721231 - ], - [ - 0.000830903783988953, - 0.02596715413167004, - 0.999662451283034, - -0.10752400043386898 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8699, - "backend_objective": 1431.0013416827755, - "backend_elapsed_sec": 0.09614579999470152, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4126, - "objective": 875.335034202349 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6831, - "objective": 1272.6586430187901 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8699, - "objective": 1431.0013416827755 - } - ], - "heldout_symmetric": { - "evaluated": 8461, - "inliers": 6527, - "inlier_ratio": 0.7714218177520388, - "inlier_rmse_m": 0.10015132538295435, - "median_m": 0.08998295155682257, - "p90_m": 0.5717583115706976, - "p95_m": 0.9766719895662097 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 55837.77513574403, - 77293.86826583483, - 252960.48439746772, - 693120.1732698919, - 957279.6658038803, - 1200438.811210849 - ], - "effective_rank": 6, - "scaled_condition_number": 21.49868629780701, - "weakest_scaled_direction": [ - -0.3021919466718487, - 0.5742483411290893, - 0.03548027703665747, - -0.24016915839401468, - 0.013787252953878485, - 0.7209637348930016 - ] - }, - "forward_reverse": { - "translation_m": 0.007439481433750378, - "rotation_deg": 0.036349268136368934 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5305885091534674e-15, - "rotation_deg": 2.0640548142816966e-14 - }, - { - "translation_m": 1.0778315928076987e-15, - "rotation_deg": 3.028739091321097e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 11146, - "frame_counter_j": 13524, - "rtk_translation_m": 8.352264787019024, - "rtk_rotation_deg": 19.411032835065622, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9418174976044725, - -0.32704777321473233, - -0.07758579278021448, - 7.464422984202929 - ], - [ - 0.3258332650347977, - 0.9450069563667773, - -0.02818751168803704, - 3.963382927634167 - ], - [ - 0.08253777682257066, - 0.0012674595398333534, - 0.9965871306330929, - 0.8333299252750302 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 5718, - "backend_objective": 203.63091669390306, - "backend_elapsed_sec": 0.09304269999847747, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3071, - "objective": 907.596233928109 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4577, - "objective": 341.7971946895485 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 5718, - "objective": 203.63091669390306 - } - ], - "heldout_symmetric": { - "evaluated": 8653, - "inliers": 4835, - "inlier_ratio": 0.5587657459840518, - "inlier_rmse_m": 0.12832496127520593, - "median_m": 0.19928204068208086, - "p90_m": 1.8624005929209129, - "p95_m": 2.808168216613647 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10476.122247598663, - 22381.941058933215, - 31673.07486214095, - 58978.8331569019, - 232748.95984646442, - 403668.9472931671 - ], - "effective_rank": 6, - "scaled_condition_number": 38.53228682833441, - "weakest_scaled_direction": [ - -0.18529410084709205, - 0.9722783146235459, - -0.002227965008042744, - -0.07682067690954515, - -0.045134498123139424, - 0.11134393541778292 - ] - }, - "forward_reverse": { - "translation_m": 0.005430301274456062, - "rotation_deg": 0.06530638270069017 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1957467920563633e-15, - "rotation_deg": 9.933564501892405e-15 - }, - { - "translation_m": 8.005932084973442e-16, - "rotation_deg": 1.2529175777050077e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 11146, - "frame_counter_j": 14726, - "rtk_translation_m": 6.346037230040679, - "rtk_rotation_deg": 25.592965647994788, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8972125233138744, - 0.4343282964429472, - -0.07980362722157111, - 5.810564210896743 - ], - [ - -0.4387622549546749, - 0.8972223936320542, - -0.049796184515047366, - 1.6929262958036027 - ], - [ - 0.049973709446478935, - 0.0796925797934476, - 0.9955660305022587, - 0.5553852774515462 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6497, - "backend_objective": 534.6845196250059, - "backend_elapsed_sec": 0.08179950000339886, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3518, - "objective": 880.0071313217519 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5432, - "objective": 463.0347830977745 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6497, - "objective": 534.6845196250059 - } - ], - "heldout_symmetric": { - "evaluated": 8271, - "inliers": 5087, - "inlier_ratio": 0.615040502962157, - "inlier_rmse_m": 0.11840729454457544, - "median_m": 0.15863689432677794, - "p90_m": 1.719130370523116, - "p95_m": 2.6709552479051744 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24462.247953490274, - 47493.95990616991, - 69163.4639683061, - 113245.55784497439, - 208276.87547963014, - 514491.5983901216 - ], - "effective_rank": 6, - "scaled_condition_number": 21.032065383701333, - "weakest_scaled_direction": [ - -0.6712475401493424, - 0.5597644121207646, - 0.030434321051525326, - 0.018545801283390596, - -0.07915719876280576, - 0.4780737244478797 - ] - }, - "forward_reverse": { - "translation_m": 0.012871328625232324, - "rotation_deg": 0.037753566213482644 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.784159510899133e-15, - "rotation_deg": 2.083823619515493e-14 - }, - { - "translation_m": 1.1086637278072168e-15, - "rotation_deg": 7.728092304312818e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 19, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 11146, - "frame_counter_j": 15687, - "rtk_translation_m": 5.607512178689573, - "rtk_rotation_deg": 59.636154090088375, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5120112987510401, - 0.8544185817207568, - -0.08839297009131361, - 2.679154080116313 - ], - [ - -0.8588963923812681, - 0.5078196973867183, - -0.06645406007540469, - 3.392816424221629 - ], - [ - -0.011891892436329076, - 0.10994563272978207, - 0.9938664602138111, - 0.21327404338897046 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6933, - "backend_objective": 884.0233130287177, - "backend_elapsed_sec": 0.09180319999722997, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3843, - "objective": 895.662589003664 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5847, - "objective": 553.3640323952637 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6933, - "objective": 884.0233130287177 - } - ], - "heldout_symmetric": { - "evaluated": 8227, - "inliers": 5129, - "inlier_ratio": 0.6234350309955026, - "inlier_rmse_m": 0.11735435665832353, - "median_m": 0.15422107292981818, - "p90_m": 1.6840291084047259, - "p95_m": 2.6873374506858796 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33806.63447463628, - 48738.23485895213, - 117985.96378394766, - 231577.233671922, - 413071.0744724565, - 550047.2753105533 - ], - "effective_rank": 6, - "scaled_condition_number": 16.270394372537467, - "weakest_scaled_direction": [ - -0.7489695945536514, - 0.19696851031118778, - -0.019173095137490572, - 0.040755624274743316, - -0.08894920675830198, - 0.6247458383293354 - ] - }, - "forward_reverse": { - "translation_m": 0.007833445352022574, - "rotation_deg": 0.016491686030251827 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.609823385706477e-15, - "rotation_deg": 4.713569038122452e-15 - }, - { - "translation_m": 7.021666937153402e-16, - "rotation_deg": 8.660476044201486e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 20, - "lidar_time_i": 1784281794.7491786, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 11146, - "frame_counter_j": 17122, - "rtk_translation_m": 8.633248754322691, - "rtk_rotation_deg": 149.96154617253603, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8620798868258004, - 0.48879838391291097, - -0.13376998398198783, - 2.470136166120419 - ], - [ - -0.48165376465394083, - -0.872363190324533, - -0.08361886845376827, - 6.4286073864258455 - ], - [ - -0.15756877776101694, - -0.007655328270504252, - 0.9874783421543837, - 0.3667225280977284 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6026, - "backend_objective": 522.0189170957937, - "backend_elapsed_sec": 0.12099010000383714, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 19, - "num_inliers": 3829, - "objective": 1264.6899360379891 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5260, - "objective": 452.8095702749315 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6026, - "objective": 522.0189170957937 - } - ], - "heldout_symmetric": { - "evaluated": 8291, - "inliers": 4612, - "inlier_ratio": 0.5562658304185261, - "inlier_rmse_m": 0.13192141621005607, - "median_m": 0.21153042073485148, - "p90_m": 1.7210371830139495, - "p95_m": 2.7309457671874293 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15567.017596654456, - 32537.707238558993, - 50923.31120711576, - 71840.71116318663, - 302109.94563786394, - 419442.7788424268 - ], - "effective_rank": 6, - "scaled_condition_number": 26.944324835385952, - "weakest_scaled_direction": [ - 0.34213717884055467, - 0.7548704475807149, - 0.012786897184138538, - -0.04880592075726528, - 0.025054774641916154, - -0.5567220975059266 - ] - }, - "forward_reverse": { - "translation_m": 0.023510650105734523, - "rotation_deg": 0.673469393155776 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.447059237218225e-15, - "rotation_deg": 2.1713794845927764e-14 - }, - { - "translation_m": 1.2755491433176288e-15, - "rotation_deg": 1.347080612622878e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282032.5400162, - "frame_counter_i": 12282, - "frame_counter_j": 13524, - "rtk_translation_m": 9.849975560032544, - "rtk_rotation_deg": 44.87442327906463, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7102233297641525, - -0.7018862364708912, - -0.05420823656464816, - 6.546859580520278 - ], - [ - 0.700596110952532, - 0.7122514192430445, - -0.043162542840478976, - 7.891766395232707 - ], - [ - 0.06890508817865072, - -0.00732303482153448, - 0.997596342206654, - 0.6928363766864664 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5817, - "backend_objective": 193.25441421890258, - "backend_elapsed_sec": 0.08441310000489466, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 2958, - "objective": 736.9230890405553 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4568, - "objective": 351.3173069198099 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5817, - "objective": 193.25441421890258 - } - ], - "heldout_symmetric": { - "evaluated": 8444, - "inliers": 4982, - "inlier_ratio": 0.5900047370914259, - "inlier_rmse_m": 0.1265936504427481, - "median_m": 0.17756188887032337, - "p90_m": 1.744083908818472, - "p95_m": 2.692710849561225 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5307.984688189913, - 9595.642722165228, - 24542.26956233285, - 64909.93466570358, - 281256.21603713726, - 480517.8850347315 - ], - "effective_rank": 6, - "scaled_condition_number": 90.52736834449948, - "weakest_scaled_direction": [ - 0.8879711724289627, - 0.38411377642912403, - 0.032863143184040454, - -0.02006206175139438, - 0.06951961956819577, - -0.24010071571307653 - ] - }, - "forward_reverse": { - "translation_m": 0.011296955150750666, - "rotation_deg": 0.21501790849158783 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.881784197001252e-16, - "rotation_deg": 3.639161690164715e-14 - }, - { - "translation_m": 1.860917887849723e-15, - "rotation_deg": 5.2655185660289347e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 12282, - "frame_counter_j": 14726, - "rtk_translation_m": 7.9099649541476005, - "rtk_rotation_deg": 0.12957520399577063, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9987058012089111, - 0.005967694885010022, - -0.05050850670359466, - 6.035498697769971 - ], - [ - -0.009303686973892424, - 0.9977714138279992, - -0.06607304409793685, - 5.124155156663671 - ], - [ - 0.050001640376686265, - 0.06645744778003067, - 0.996535620835605, - 0.4770025998301771 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6736, - "backend_objective": 452.2055109206372, - "backend_elapsed_sec": 0.07670710000093095, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3260, - "objective": 833.8983675285479 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5328, - "objective": 406.48955527023446 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6736, - "objective": 452.2055109206372 - } - ], - "heldout_symmetric": { - "evaluated": 8062, - "inliers": 5217, - "inlier_ratio": 0.6471098982882659, - "inlier_rmse_m": 0.12019779875781794, - "median_m": 0.1509105384994479, - "p90_m": 1.7168833151835579, - "p95_m": 2.841151381473104 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14226.795232678189, - 59270.37658277949, - 73741.20570561186, - 96238.30991169997, - 215586.86618071568, - 546985.0876606673 - ], - "effective_rank": 6, - "scaled_condition_number": 38.44752656622707, - "weakest_scaled_direction": [ - 0.5771337134262265, - 0.7385149868664682, - 0.0014072030315212636, - -0.0764565237402876, - 0.047792798210252584, - -0.3367202981658338 - ] - }, - "forward_reverse": { - "translation_m": 0.016821400599454826, - "rotation_deg": 0.06522344447557246 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.849726278076531e-15, - "rotation_deg": 6.820469087873063e-14 - }, - { - "translation_m": 1.1102230246251565e-16, - "rotation_deg": 7.254239957964296e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 12282, - "frame_counter_j": 15687, - "rtk_translation_m": 6.609737623005951, - "rtk_rotation_deg": 34.172763646089344, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8331053475649987, - 0.5522437403187099, - -0.031021462528453867, - 2.4746694003430205 - ], - [ - -0.5520324130213826, - 0.8266607348695248, - -0.10905156761260716, - 5.305832918991947 - ], - [ - -0.03457882057550575, - 0.10797629695344377, - 0.9935519233859041, - 0.24555144777693338 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 6913, - "backend_objective": 849.3640821769262, - "backend_elapsed_sec": 0.13104209999437444, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3613, - "objective": 798.4099519902669 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5794, - "objective": 605.5436075821551 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 6913, - "objective": 849.3640821769262 - } - ], - "heldout_symmetric": { - "evaluated": 8018, - "inliers": 5036, - "inlier_ratio": 0.6280868046894488, - "inlier_rmse_m": 0.12242728727104996, - "median_m": 0.15982050263896022, - "p90_m": 1.6883188431263076, - "p95_m": 2.6764277449203657 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 17385.77170497271, - 36134.09221190568, - 51832.29643967986, - 160634.8878490351, - 432024.4152587716, - 574528.5874227288 - ], - "effective_rank": 6, - "scaled_condition_number": 33.04590657073916, - "weakest_scaled_direction": [ - -0.7457607868252705, - 0.1538594948580726, - -0.031861723767725114, - -0.0472806771522627, - -0.06185741869124247, - 0.6427216602505329 - ] - }, - "forward_reverse": { - "translation_m": 0.06745241310870236, - "rotation_deg": 1.6183598806956783 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.532855638319363e-07, - "rotation_deg": 4.580909343002165e-06 - }, - { - "translation_m": 4.532855664480938e-07, - "rotation_deg": 4.580909329859064e-06 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 20, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 12282, - "frame_counter_j": 17122, - "rtk_translation_m": 9.541288639020653, - "rtk_rotation_deg": 124.49815572853673, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.571715130675369, - 0.8162127656630495, - -0.08329784226210957, - 0.9767776112492216 - ], - [ - -0.8093225660000615, - -0.5777115903748182, - -0.10604858560901438, - 7.949862540775063 - ], - [ - -0.1346803382826224, - 0.006785242462443379, - 0.9908658672922411, - 0.29790238927882146 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6232, - "backend_objective": 513.7635116583571, - "backend_elapsed_sec": 0.17997939999622758, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3610, - "objective": 1357.563480706797 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5209, - "objective": 489.4682499336968 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6232, - "objective": 513.7635116583571 - } - ], - "heldout_symmetric": { - "evaluated": 8082, - "inliers": 4681, - "inlier_ratio": 0.5791883197228409, - "inlier_rmse_m": 0.127436475456937, - "median_m": 0.18858820331337045, - "p90_m": 1.6798930630468436, - "p95_m": 2.805701308759569 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 12468.52107972311, - 22655.304911037623, - 53563.57150624327, - 73209.11606962135, - 380179.03799744166, - 510525.4869915539 - ], - "effective_rank": 6, - "scaled_condition_number": 40.945151692592816, - "weakest_scaled_direction": [ - -0.3923342092174033, - -0.7059650327182809, - -0.01465582822048815, - 0.039893193399784456, - -0.010247074248178296, - 0.5880271916720547 - ] - }, - "forward_reverse": { - "translation_m": 2.599521231663455, - "rotation_deg": 5.87323656621683 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.503168468209964e-15, - "rotation_deg": 3.48611937076645e-14 - }, - { - "translation_m": 4.896322696446008e-15, - "rotation_deg": 1.8111910407921455e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 16, - "j": 21, - "lidar_time_i": 1784281908.3446162, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 12282, - "frame_counter_j": 18410, - "rtk_translation_m": 9.407850320517097, - "rtk_rotation_deg": 175.38299577015903, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9909874123338378, - 0.0821385004569138, - -0.10581689533611122, - -1.5782627506350164 - ], - [ - -0.07193034453209338, - -0.9926893840412072, - -0.09692168151338362, - 9.195812870389304 - ], - [ - -0.11300431023362913, - -0.08843672062314946, - 0.9896509345794826, - 0.1952073144911196 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5709, - "backend_objective": 498.92756422803666, - "backend_elapsed_sec": 0.11415320000378415, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 18, - "num_inliers": 3524, - "objective": 1016.9395424266695 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 4951, - "objective": 530.1319027098068 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5709, - "objective": 498.92756422803666 - } - ], - "heldout_symmetric": { - "evaluated": 8257, - "inliers": 4081, - "inlier_ratio": 0.49424730531670097, - "inlier_rmse_m": 0.13389808634231865, - "median_m": 0.25476905894367896, - "p90_m": 1.7479641408742923, - "p95_m": 2.7904930053206223 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10577.17789211361, - 16349.87938238224, - 41541.746537241284, - 68535.78360826505, - 334688.7705395411, - 479031.1293750813 - ], - "effective_rank": 6, - "scaled_condition_number": 45.28912477989511, - "weakest_scaled_direction": [ - -0.017365371616825397, - -0.7369681412943482, - -0.025812733259332803, - 0.004898661483407918, - 0.01309260261617339, - 0.6750664354416175 - ] - }, - "forward_reverse": { - "translation_m": 0.04478742358365585, - "rotation_deg": 0.10475809279093058 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2728049099669922e-15, - "rotation_deg": 3.285410348688876e-14 - }, - { - "translation_m": 2.3128906185831588e-15, - "rotation_deg": 3.64618419040048e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282152.7353525, - "frame_counter_i": 13524, - "frame_counter_j": 14726, - "rtk_translation_m": 2.081596655954183, - "rtk_rotation_deg": 45.003998483060414, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7060889127890213, - 0.7080948615336959, - -0.006333585555963055, - -2.324982136224881 - ], - [ - -0.7080570607394956, - 0.7058725064170783, - -0.019980075610909497, - -1.6103753096630251 - ], - [ - -0.009677084962145087, - 0.01859224983824685, - 0.9997803170059845, - -0.03875773060724815 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 7370, - "backend_objective": 980.9065722761011, - "backend_elapsed_sec": 0.1194441999978153, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3715, - "objective": 883.4938725288476 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6044, - "objective": 739.7978945748894 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 7370, - "objective": 980.9065722761011 - } - ], - "heldout_symmetric": { - "evaluated": 8254, - "inliers": 6297, - "inlier_ratio": 0.7629028349890962, - "inlier_rmse_m": 0.10358638519274684, - "median_m": 0.10000777608550016, - "p90_m": 0.7375049962673237, - "p95_m": 1.602798043220705 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40053.97928784006, - 108738.0958039393, - 183435.98128710146, - 271901.80075056653, - 358707.63716683054, - 746201.3494956727 - ], - "effective_rank": 6, - "scaled_condition_number": 18.62989302843653, - "weakest_scaled_direction": [ - -0.48891554760539574, - 0.5619211679145203, - -0.02127617534876025, - -0.17429599986590583, - 0.06611127171867963, - -0.6403153261513489 - ] - }, - "forward_reverse": { - "translation_m": 0.007136146106563684, - "rotation_deg": 0.13887814859043496 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.407523046883221e-16, - "rotation_deg": 1.286393106742583e-14 - }, - { - "translation_m": 1.3913996292750186e-15, - "rotation_deg": 4.332764772017017e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 13524, - "frame_counter_j": 15687, - "rtk_translation_m": 4.34928579963815, - "rtk_rotation_deg": 79.047186925154, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.20173542656049445, - 0.978975188906406, - -0.03017278866995732, - -4.735049394375317 - ], - [ - -0.9789854744710699, - 0.20060762884524821, - -0.036660878654795975, - 1.0199078702183717 - ], - [ - -0.029837199015824812, - 0.03693451982568126, - 0.9988721553833287, - -0.13742071141353582 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6495, - "backend_objective": 342.8863756815649, - "backend_elapsed_sec": 0.11054340000555385, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3621, - "objective": 854.621916657401 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5456, - "objective": 468.35806913054256 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6495, - "objective": 342.8863756815649 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 5524, - "inlier_ratio": 0.6728380024360536, - "inlier_rmse_m": 0.10727518915463004, - "median_m": 0.11990532826372502, - "p90_m": 1.2331715318408036, - "p95_m": 2.0730742543993914 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20890.4939494118, - 34420.71302012863, - 44921.03632632975, - 65486.47357955509, - 319597.69207243994, - 706420.6719865692 - ], - "effective_rank": 6, - "scaled_condition_number": 33.81541258417489, - "weakest_scaled_direction": [ - 0.7393379623243183, - -0.5963685178044921, - 0.0289778622258286, - 0.14905628799182316, - 0.050897013615230725, - 0.26846967976620556 - ] - }, - "forward_reverse": { - "translation_m": 0.0017207670327870018, - "rotation_deg": 0.035486867252565536 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.905391235859706e-07, - "rotation_deg": 1.1951139807427482e-05 - }, - { - "translation_m": 2.7822109252321576e-15, - "rotation_deg": 1.425795767675707e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 13524, - "frame_counter_j": 17122, - "rtk_translation_m": 4.4206846692505035, - "rtk_rotation_deg": 169.37257900760153, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.981689741673125, - 0.17503737785350298, - -0.07514763767359972, - -3.93421742278851 - ], - [ - -0.17375918822824543, - -0.9845131124392799, - -0.023273932658283095, - 3.9461807881083826 - ], - [ - -0.07805764280333986, - -0.009790188419592633, - 0.9969007757097471, - -0.06008100495921305 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6328, - "backend_objective": 421.51590804100243, - "backend_elapsed_sec": 0.10009140000329353, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3718, - "objective": 909.6338967531472 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5439, - "objective": 549.0582206511566 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6328, - "objective": 421.51590804100243 - } - ], - "heldout_symmetric": { - "evaluated": 8274, - "inliers": 5258, - "inlier_ratio": 0.6354846507130771, - "inlier_rmse_m": 0.11168219002675635, - "median_m": 0.1422128499224208, - "p90_m": 1.2439478657522292, - "p95_m": 1.9482182033239916 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16991.467608062278, - 41812.06516351033, - 56328.47540744242, - 67122.87991572126, - 359275.6917557686, - 652558.3398507584 - ], - "effective_rank": 6, - "scaled_condition_number": 38.40506040461897, - "weakest_scaled_direction": [ - 0.40937549455267525, - 0.8521417336779876, - 0.013271772889715717, - -0.06716933784289171, - 0.12093503277199806, - 0.2948779885487776 - ] - }, - "forward_reverse": { - "translation_m": 0.020290214498459216, - "rotation_deg": 0.2831192364677464 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6300346472626374e-15, - "rotation_deg": 1.2905397487224749e-14 - }, - { - "translation_m": 2.5159782473646242e-15, - "rotation_deg": 1.4087016975794695e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 21, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 13524, - "frame_counter_j": 18410, - "rtk_translation_m": 6.400116212709096, - "rtk_rotation_deg": 139.7425809507742, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7611079264481618, - -0.6432415351488416, - -0.08339695292479797, - -4.880588611475269 - ], - [ - 0.6460247477361825, - -0.7632662758557905, - -0.008753139644348006, - 6.643547004823147 - ], - [ - -0.05802369869442864, - -0.06053857943982982, - 0.9964779630223769, - -0.04565445488914063 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6067, - "backend_objective": 309.5235928483319, - "backend_elapsed_sec": 0.11562870000489056, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3784, - "objective": 1431.597619002345 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5415, - "objective": 562.324758742745 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6067, - "objective": 309.5235928483319 - } - ], - "heldout_symmetric": { - "evaluated": 8449, - "inliers": 4812, - "inlier_ratio": 0.5695348561959995, - "inlier_rmse_m": 0.1231813524465837, - "median_m": 0.1888648460290231, - "p90_m": 1.3787862968217646, - "p95_m": 2.0013386026113054 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10129.051212593078, - 20618.707321907415, - 26827.8803266032, - 39826.78927145235, - 369144.0643862018, - 585279.3554166609 - ], - "effective_rank": 6, - "scaled_condition_number": 57.78224861663297, - "weakest_scaled_direction": [ - 0.4524425226130679, - -0.8668479586489823, - -0.006391844190337294, - 0.13907757366262805, - -0.027334904919392347, - -0.154077110962746 - ] - }, - "forward_reverse": { - "translation_m": 0.009859208985419086, - "rotation_deg": 0.31053558178227947 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.946692800781008e-15, - "rotation_deg": 3.806829528700142e-14 - }, - { - "translation_m": 9.124284020788476e-15, - "rotation_deg": 5.1432761808339316e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 22, - "lidar_time_i": 1784282032.5400162, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 13524, - "frame_counter_j": 19343, - "rtk_translation_m": 8.798226453379533, - "rtk_rotation_deg": 96.08482130259475, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1033540141338549, - -0.9922589624874357, - -0.0688483778006262, - -3.699906137437823 - ], - [ - 0.994574476675296, - -0.10392096553298631, - 0.004695025958632048, - 9.757808447286939 - ], - [ - -0.011813471482984693, - -0.06798958954171364, - 0.9976160872828135, - 0.02168485171069871 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5824, - "backend_objective": 353.92642070597697, - "backend_elapsed_sec": 0.105740799997875, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3629, - "objective": 1222.574240537578 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5272, - "objective": 556.7907455753679 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5824, - "objective": 353.92642070597697 - } - ], - "heldout_symmetric": { - "evaluated": 8278, - "inliers": 4519, - "inlier_ratio": 0.5459048079246195, - "inlier_rmse_m": 0.1287223998113377, - "median_m": 0.20750534883444208, - "p90_m": 1.3262885512599953, - "p95_m": 2.1013089503069096 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10229.633897536547, - 20018.710191223454, - 25434.536340675808, - 36096.637286828045, - 290824.4190971514, - 641994.558447521 - ], - "effective_rank": 6, - "scaled_condition_number": 62.758312260043155, - "weakest_scaled_direction": [ - 0.9387291943448326, - -0.09394094061567632, - 0.006109687082178901, - 0.057378035750000625, - 0.06816897796787551, - -0.31935250514281016 - ] - }, - "forward_reverse": { - "translation_m": 0.03194615937469955, - "rotation_deg": 0.5773515871730924 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.268340157421459e-12, - "rotation_deg": 1.4024774928902618e-10 - }, - { - "translation_m": 2.767925512340501e-12, - "rotation_deg": 7.715157471287801e-11 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282248.831164, - "frame_counter_i": 14726, - "frame_counter_j": 15687, - "rtk_translation_m": 3.459222336215112, - "rtk_rotation_deg": 34.04318844209358, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8356396048912293, - 0.5492646423826864, - -0.0038475141910832775, - -3.56771603140493 - ], - [ - -0.5491651382245906, - 0.835305163608998, - -0.026133017562312358, - 0.14516883533103006 - ], - [ - -0.011140094074873185, - 0.02395070513295354, - 0.9996510701377943, - -0.12978734867907502 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8199, - "backend_objective": 741.3931721836564, - "backend_elapsed_sec": 0.12332069999683881, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4088, - "objective": 961.6873192136786 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6557, - "objective": 609.1600446234677 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8199, - "objective": 741.3931721836564 - } - ], - "heldout_symmetric": { - "evaluated": 7828, - "inliers": 5920, - "inlier_ratio": 0.7562595809913132, - "inlier_rmse_m": 0.11139160446923307, - "median_m": 0.11190472236589606, - "p90_m": 0.8079478135406484, - "p95_m": 1.3171246693436498 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 79356.83525361754, - 81361.99209405147, - 154537.26707912018, - 239726.2205963392, - 383296.65268360724, - 762263.8775446839 - ], - "effective_rank": 6, - "scaled_condition_number": 9.605522638453952, - "weakest_scaled_direction": [ - 0.8578356690151397, - -0.20294710418152312, - -0.00042804519883183365, - 0.03949632630946456, - 0.073035300013174, - -0.46479688016060444 - ] - }, - "forward_reverse": { - "translation_m": 0.013156152321531143, - "rotation_deg": 0.09121207325672914 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.878779230325418e-06, - "rotation_deg": 4.792593290068823e-05 - }, - { - "translation_m": 1.2670655869532562e-15, - "rotation_deg": 1.4127710038631277e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 14726, - "frame_counter_j": 17122, - "rtk_translation_m": 4.94806857498194, - "rtk_rotation_deg": 124.36858052454107, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.570138685705177, - 0.8207578609489499, - -0.03603349487460453, - -5.082082941590957 - ], - [ - -0.819494244427104, - -0.571265532332821, - -0.04566043056463954, - 2.782822882920512 - ], - [ - -0.058060850951594474, - 0.0034964637854758836, - 0.9983069229088682, - -0.09988187979695946 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7018, - "backend_objective": 494.33938050930027, - "backend_elapsed_sec": 0.11729900000500493, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4047, - "objective": 1033.8564976077014 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5925, - "objective": 706.1525641476267 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7018, - "objective": 494.33938050930027 - } - ], - "heldout_symmetric": { - "evaluated": 7892, - "inliers": 5263, - "inlier_ratio": 0.6668778509883426, - "inlier_rmse_m": 0.1149564835181103, - "median_m": 0.1352750618488363, - "p90_m": 1.054510521672473, - "p95_m": 1.6596179332911616 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34436.291861267186, - 54456.834804635044, - 64324.72107727979, - 134685.61415153305, - 339384.2349875465, - 646177.3444256904 - ], - "effective_rank": 6, - "scaled_condition_number": 18.76442873201715, - "weakest_scaled_direction": [ - 0.0865286547797389, - 0.9560205677665312, - -0.0033158592484256147, - -0.06457200904962684, - 0.04777232586683662, - -0.26846737514152474 - ] - }, - "forward_reverse": { - "translation_m": 0.0076759006397633354, - "rotation_deg": 0.11713903044228172 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6067439801475816e-15, - "rotation_deg": 1.8034280756477328e-14 - }, - { - "translation_m": 3.3494163781626583e-15, - "rotation_deg": 1.3111645899685401e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 14726, - "frame_counter_j": 18410, - "rtk_translation_m": 6.5847443121227816, - "rtk_rotation_deg": 175.25342056617163, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9949749911988532, - 0.08639635189479178, - -0.05060076351314392, - -7.662779682867011 - ], - [ - -0.08473557130758755, - -0.9958198394207861, - -0.03409883240137704, - 4.0129209329112365 - ], - [ - -0.05333525891957905, - -0.029639800863564925, - 0.9981366802000368, - -0.16178867695152757 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6462, - "backend_objective": 413.1823953597963, - "backend_elapsed_sec": 0.13680150000436697, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 4059, - "objective": 1177.943822446005 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5669, - "objective": 616.006829925897 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6462, - "objective": 413.1823953597963 - } - ], - "heldout_symmetric": { - "evaluated": 8067, - "inliers": 4822, - "inlier_ratio": 0.5977438948803768, - "inlier_rmse_m": 0.12625086545570646, - "median_m": 0.17682107874368982, - "p90_m": 1.1793804079177113, - "p95_m": 1.7241449064011338 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 19348.09431023545, - 31651.065666632057, - 35610.60735532536, - 70613.23681215479, - 255632.71127269874, - 515950.0852090167 - ], - "effective_rank": 6, - "scaled_condition_number": 26.666713369082085, - "weakest_scaled_direction": [ - -0.6170990980603307, - 0.7629611016209566, - -4.431396718401545e-05, - -0.14246157460012185, - 0.03113191415770684, - -0.12575596330220848 - ] - }, - "forward_reverse": { - "translation_m": 0.021119392446408227, - "rotation_deg": 0.18202979634982344 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.4771945964160176e-15, - "rotation_deg": 8.461620723670677e-15 - }, - { - "translation_m": 5.07010500352012e-15, - "rotation_deg": 2.137506176837694e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 22, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 14726, - "frame_counter_j": 19343, - "rtk_translation_m": 9.20681259274594, - "rtk_rotation_deg": 141.08881978565523, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.777217640042936, - -0.6261430612235105, - -0.06227043349568842, - -9.028089438927536 - ], - [ - 0.6282295362635718, - -0.777753994758715, - -0.020648811174485932, - 7.053940951724084 - ], - [ - -0.03550196856720969, - -0.05516874584865414, - 0.9978456893274327, - -0.18774052311110073 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 5828, - "backend_objective": 335.0320758252906, - "backend_elapsed_sec": 0.1571025999946869, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 22, - "num_inliers": 3699, - "objective": 1294.133104901423 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5214, - "objective": 566.1598641180501 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 5828, - "objective": 335.0320758252906 - } - ], - "heldout_symmetric": { - "evaluated": 7896, - "inliers": 4174, - "inlier_ratio": 0.5286220871327254, - "inlier_rmse_m": 0.13561310095446666, - "median_m": 0.2266709164509707, - "p90_m": 1.3064327289886077, - "p95_m": 2.000919144660866 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 9155.43669348682, - 19672.928266232062, - 24075.804626674133, - 54100.23811168628, - 230546.0909323727, - 597171.9656806894 - ], - "effective_rank": 6, - "scaled_condition_number": 65.22594013516775, - "weakest_scaled_direction": [ - 0.9862029606670814, - 0.07609900329633977, - 0.013643993076005645, - 0.023571040233445296, - 0.0657724742481554, - 0.12862694591460264 - ] - }, - "forward_reverse": { - "translation_m": 0.03713510940704989, - "rotation_deg": 0.6483189610135184 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7843618982877262e-15, - "rotation_deg": 3.242737309321394e-15 - }, - { - "translation_m": 7.367837660024574e-15, - "rotation_deg": 2.907105034657369e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 18, - "j": 23, - "lidar_time_i": 1784282152.7353525, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 14726, - "frame_counter_j": 20027, - "rtk_translation_m": 13.164275822166362, - "rtk_rotation_deg": 109.14103513098563, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3249300252923515, - -0.9450813391730081, - -0.03523834573971629, - -10.83482978113538 - ], - [ - 0.9454239449018544, - -0.325556793593735, - 0.013650587942883775, - 10.69950143066267 - ], - [ - -0.02437299878412895, - -0.02887968995552108, - 0.999285705110574, - -0.15907896446026204 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 4945, - "backend_objective": 238.87004958058156, - "backend_elapsed_sec": 0.2299674000023515, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3622, - "objective": 1811.256551512719 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 14, - "num_inliers": 4982, - "objective": 525.9946945412389 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 4945, - "objective": 238.87004958058156 - } - ], - "heldout_symmetric": { - "evaluated": 7850, - "inliers": 3701, - "inlier_ratio": 0.47146496815286626, - "inlier_rmse_m": 0.14168298172295804, - "median_m": 0.2745116892735326, - "p90_m": 1.6611046882664817, - "p95_m": 2.553829973963533 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5353.016649824014, - 13639.542347675055, - 17166.41657049205, - 25512.03711029395, - 180330.60297528756, - 604434.2492385092 - ], - "effective_rank": 6, - "scaled_condition_number": 112.91469628781756, - "weakest_scaled_direction": [ - 0.9385804655255442, - 0.3279015838459074, - 0.020479752249664213, - 0.005060023065294971, - 0.0777670871854315, - 0.07109512719070406 - ] - }, - "forward_reverse": { - "translation_m": 0.01208598984738065, - "rotation_deg": 0.6082838532521024 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2777160817397065e-14, - "rotation_deg": 2.7369202532343456e-13 - }, - { - "translation_m": 3.666359205665212e-14, - "rotation_deg": 3.5710657920062396e-13 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282392.325837, - "frame_counter_i": 15687, - "frame_counter_j": 17122, - "rtk_translation_m": 3.031758915138065, - "rtk_rotation_deg": 90.32539208244746, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.025739357234676605, - 0.9995585911337304, - -0.014836050009942732, - -2.71435132781464 - ], - [ - -0.9990041931713595, - -0.02626044674540959, - -0.03606952956129582, - 1.3664802257239488 - ], - [ - -0.036443209452343625, - 0.013892869663367854, - 0.9992391508829751, - -0.08948901367685502 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 8308, - "backend_objective": 1517.861896369934, - "backend_elapsed_sec": 0.14077059999544872, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4467, - "objective": 965.7707702452477 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6961, - "objective": 746.1117845473925 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 8308, - "objective": 1517.861896369934 - } - ], - "heldout_symmetric": { - "evaluated": 7848, - "inliers": 5815, - "inlier_ratio": 0.7409531090723751, - "inlier_rmse_m": 0.11651827109675585, - "median_m": 0.12261444438249264, - "p90_m": 0.6255899780243315, - "p95_m": 0.9726402369535453 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 80423.24881238765, - 130764.89743239863, - 220204.2621480841, - 340435.28303629305, - 517783.9781361802, - 809127.8380679083 - ], - "effective_rank": 6, - "scaled_condition_number": 10.060869835729363, - "weakest_scaled_direction": [ - -0.1662804548830486, - -0.06198608636788827, - -0.01527653471497872, - -0.09412816637504243, - -0.9790772137522035, - 0.02868554886828434 - ] - }, - "forward_reverse": { - "translation_m": 0.0051743650857167135, - "rotation_deg": 0.07263138471648796 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.156774043330696e-07, - "rotation_deg": 6.32677911293002e-06 - }, - { - "translation_m": 1.5004064489311687e-15, - "rotation_deg": 3.874797467642067e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 15687, - "frame_counter_j": 18410, - "rtk_translation_m": 3.732423384308353, - "rtk_rotation_deg": 141.21023212407198, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7848036151675973, - 0.619002017712907, - -0.030328001701719298, - -5.558305059605946 - ], - [ - -0.6183048570168526, - -0.7853760650007595, - -0.02972440602084526, - 0.9731548141931269 - ], - [ - -0.04221835393805353, - -0.004575870548080443, - 0.9990979291338206, - -0.15808276184445877 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7494, - "backend_objective": 860.4455798918295, - "backend_elapsed_sec": 0.11359380000067176, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4408, - "objective": 1288.9501899829115 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6492, - "objective": 798.2525944526354 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7494, - "objective": 860.4455798918295 - } - ], - "heldout_symmetric": { - "evaluated": 8023, - "inliers": 5266, - "inlier_ratio": 0.6563629565000623, - "inlier_rmse_m": 0.12291187901196955, - "median_m": 0.15064438947225078, - "p90_m": 0.8438788157607275, - "p95_m": 1.2515477435791516 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41430.465588848856, - 55738.64678287068, - 96322.65182286796, - 166197.53168911196, - 414477.87300157564, - 635527.9142253236 - ], - "effective_rank": 6, - "scaled_condition_number": 15.339627619255575, - "weakest_scaled_direction": [ - -0.006222973995830481, - -0.3362104453890515, - -0.027329590559903052, - 0.6534727888571428, - -0.643408467107404, - 0.2125459083669671 - ] - }, - "forward_reverse": { - "translation_m": 0.0075358808329252175, - "rotation_deg": 0.06620678153945667 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.991016288122638e-15, - "rotation_deg": 1.636068016419404e-14 - }, - { - "translation_m": 3.9670067233741415e-07, - "rotation_deg": 3.3618910305719702e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 15687, - "frame_counter_j": 19343, - "rtk_translation_m": 6.37255124464243, - "rtk_rotation_deg": 175.13200822775684, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9941776950597708, - -0.09592384926564294, - -0.049084883494860794, - -8.361065190125789 - ], - [ - 0.09727759199264194, - -0.994918361359694, - -0.025971606139294723, - 2.7630390141232057 - ], - [ - -0.046344155421745976, - -0.030595250798183645, - 0.9984568843404513, - -0.19573758310243158 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6586, - "backend_objective": 409.85015788804515, - "backend_elapsed_sec": 0.11121850000199629, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 19, - "num_inliers": 3902, - "objective": 1032.5297228287486 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5646, - "objective": 571.5753340468408 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6586, - "objective": 409.85015788804515 - } - ], - "heldout_symmetric": { - "evaluated": 7852, - "inliers": 4626, - "inlier_ratio": 0.5891492613346918, - "inlier_rmse_m": 0.12519472268444526, - "median_m": 0.17609524097044943, - "p90_m": 1.2311531217177614, - "p95_m": 1.8023280882566661 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24530.84224938827, - 30837.919660583273, - 40352.664500084094, - 210398.43592173947, - 385576.47599722084, - 694275.2791532425 - ], - "effective_rank": 6, - "scaled_condition_number": 28.30213785955742, - "weakest_scaled_direction": [ - -0.38488906185602095, - 0.06038766587956955, - -0.001399684435525816, - -0.9209416317593776, - -0.008769024869184398, - 0.0011814617677586234 - ] - }, - "forward_reverse": { - "translation_m": 0.010212573357042046, - "rotation_deg": 0.11056129275235052 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.667053162230112e-06, - "rotation_deg": 1.0798339262154593e-05 - }, - { - "translation_m": 9.72552922168604e-07, - "rotation_deg": 3.3169903727314494e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 23, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 15687, - "frame_counter_j": 20027, - "rtk_translation_m": 10.37094757900695, - "rtk_rotation_deg": 143.1842235730793, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7901523468745162, - -0.6107220481233084, - -0.051747933917851284, - -11.854931521177805 - ], - [ - 0.6108658529822221, - -0.7915951710772986, - 0.01483222125663261, - 4.822144929598029 - ], - [ - -0.05002177914666693, - -0.019891331357505527, - 0.9985500270631545, - -0.29482882908658975 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5454, - "backend_objective": 289.75336967137235, - "backend_elapsed_sec": 0.10817080000560964, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3664, - "objective": 1264.3250834867924 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5056, - "objective": 517.5203323014636 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5454, - "objective": 289.75336967137235 - } - ], - "heldout_symmetric": { - "evaluated": 7806, - "inliers": 3891, - "inlier_ratio": 0.4984627209838586, - "inlier_rmse_m": 0.13443006540917718, - "median_m": 0.2518730428918361, - "p90_m": 1.7669018344418363, - "p95_m": 2.8065250605179632 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6915.736324230611, - 16080.971070088182, - 22232.35139987582, - 29461.191162011983, - 235355.85877134962, - 665454.4730598385 - ], - "effective_rank": 6, - "scaled_condition_number": 96.22322799212152, - "weakest_scaled_direction": [ - 0.9483345147193819, - 0.2747837043362865, - 0.02010961364344444, - 0.005768391573351547, - 0.07618287134544725, - 0.13752840882709905 - ] - }, - "forward_reverse": { - "translation_m": 0.02229275506707497, - "rotation_deg": 0.2903847316754494 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.535759671556655e-15, - "rotation_deg": 5.980459930205193e-14 - }, - { - "translation_m": 1.217454592664719e-15, - "rotation_deg": 6.525576398152575e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 24, - "lidar_time_i": 1784282248.831164, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 15687, - "frame_counter_j": 20855, - "rtk_translation_m": 7.752290899896264, - "rtk_rotation_deg": 99.91483670708607, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.16193428260774095, - -0.9860652469684292, - -0.0381132107989753, - -8.67742448710782 - ], - [ - 0.9866691138279127, - -0.16242448061815126, - 0.010116714583598769, - 4.150951549871499 - ], - [ - -0.016166259133099097, - -0.03596688500571904, - 0.9992222151496768, - -0.13186725757960355 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6413, - "backend_objective": 405.4833578879405, - "backend_elapsed_sec": 0.10886330000357702, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3824, - "objective": 1740.8781148806195 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5616, - "objective": 628.7453432069508 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6413, - "objective": 405.4833578879405 - } - ], - "heldout_symmetric": { - "evaluated": 7815, - "inliers": 4480, - "inlier_ratio": 0.5732565579014716, - "inlier_rmse_m": 0.1300803661721533, - "median_m": 0.19334699920317183, - "p90_m": 1.4107283359809373, - "p95_m": 2.268270699718537 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14330.371332862476, - 29893.0918259055, - 37637.360127168664, - 98748.25993421908, - 336873.2946937004, - 650307.2331651767 - ], - "effective_rank": 6, - "scaled_condition_number": 45.37964984018865, - "weakest_scaled_direction": [ - -0.4068788123436113, - -0.9102070626123997, - -0.018644123528388217, - 0.05672058253582406, - -0.047884373500570045, - 0.010723534187528916 - ] - }, - "forward_reverse": { - "translation_m": 0.07078749161909308, - "rotation_deg": 0.6582469262123747 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2888024527136935e-06, - "rotation_deg": 1.1011577322779559e-05 - }, - { - "translation_m": 6.147531058296644e-15, - "rotation_deg": 1.3574121532173272e-13 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282521.1221898, - "frame_counter_i": 17122, - "frame_counter_j": 18410, - "rtk_translation_m": 2.057726146362386, - "rtk_rotation_deg": 50.884840041624386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6395449310763489, - 0.7687496615409016, - 0.0024978020931547312, - 0.4687339764245485 - ], - [ - -0.7686090599938725, - 0.6394842398356906, - -0.017321082446101584, - -2.8230208001717894 - ], - [ - -0.014912881340763703, - 0.009157777160289409, - 0.9998468588176883, - -0.04468205702967698 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 9137, - "backend_objective": 1182.70762260448, - "backend_elapsed_sec": 0.078512200001569, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4672, - "objective": 907.1031686148219 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7326, - "objective": 688.1571814326416 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 9137, - "objective": 1182.70762260448 - } - ], - "heldout_symmetric": { - "evaluated": 8087, - "inliers": 6315, - "inlier_ratio": 0.7808828984790405, - "inlier_rmse_m": 0.11119787612354914, - "median_m": 0.10877006396340823, - "p90_m": 0.5486396480481777, - "p95_m": 0.8598015030080081 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 74971.85429305334, - 171735.7804816571, - 302264.7018190518, - 343060.7223177358, - 680907.8133937123, - 793526.4632159139 - ], - "effective_rank": 6, - "scaled_condition_number": 10.584324886965474, - "weakest_scaled_direction": [ - 0.07909461325697613, - 0.09520530095421094, - -0.0007627608268938775, - -0.7007427149112185, - 0.7022846240673357, - -0.02086540958917273 - ] - }, - "forward_reverse": { - "translation_m": 0.0031476308503252674, - "rotation_deg": 0.022487168529706673 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4831938166996518e-14, - "rotation_deg": 4.175800096125572e-13 - }, - { - "translation_m": 1.1322097734007351e-15, - "rotation_deg": 1.323337378202001e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 17122, - "frame_counter_j": 19343, - "rtk_translation_m": 4.388457127616061, - "rtk_rotation_deg": 94.54259968980386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07019151224718564, - 0.9975321253672126, - -0.0016764452944088605, - -1.249103332779739 - ], - [ - -0.9969738353219306, - -0.0702083196959857, - -0.03337609217609748, - -5.670851382501102 - ], - [ - -0.03341142457205718, - -0.0006713462878675328, - 0.999441457015981, - -0.045410977697476526 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7447, - "backend_objective": 662.2961843339123, - "backend_elapsed_sec": 0.10036509999918053, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4161, - "objective": 1094.8624289785055 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6162, - "objective": 738.0553548058183 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7447, - "objective": 662.2961843339123 - } - ], - "heldout_symmetric": { - "evaluated": 7916, - "inliers": 5191, - "inlier_ratio": 0.6557604850934815, - "inlier_rmse_m": 0.11898674179731801, - "median_m": 0.1439955500514084, - "p90_m": 1.0820764069478983, - "p95_m": 1.5441379109263882 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41494.043780185086, - 59705.91684899521, - 115429.46811057995, - 176013.68296336784, - 497032.35997360013, - 700575.3396850093 - ], - "effective_rank": 6, - "scaled_condition_number": 16.883756700029306, - "weakest_scaled_direction": [ - 0.07682011233021456, - -0.10299780403473364, - -0.0024522007625594634, - 0.9915598773466017, - -0.015910076129293998, - -0.006323648548786686 - ] - }, - "forward_reverse": { - "translation_m": 0.008500396323601164, - "rotation_deg": 0.06463449106814506 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5318501588558664e-15, - "rotation_deg": 6.023478324697416e-15 - }, - { - "translation_m": 4.145163035616955e-15, - "rotation_deg": 8.717665780651885e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 17122, - "frame_counter_j": 20027, - "rtk_translation_m": 8.256548639868363, - "rtk_rotation_deg": 126.4903843444735, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5883275322750665, - 0.8070705788867297, - -0.05007789395100734, - -3.205003884977883 - ], - [ - -0.8068294506714909, - -0.5900181747818201, - -0.03007974328797271, - -9.24101292520687 - ], - [ - -0.05382334341407922, - 0.022707578527195946, - 0.9982922485831299, - -0.17744394224989266 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6386, - "backend_objective": 369.6954712737488, - "backend_elapsed_sec": 0.10228469999856316, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3915, - "objective": 1274.9860423984346 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5647, - "objective": 592.0598773446236 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6386, - "objective": 369.6954712737488 - } - ], - "heldout_symmetric": { - "evaluated": 7870, - "inliers": 4591, - "inlier_ratio": 0.5833545108005083, - "inlier_rmse_m": 0.12863144503040289, - "median_m": 0.18860633761395, - "p90_m": 1.5334246920678039, - "p95_m": 2.2704339331424603 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14377.108180612453, - 25478.90534500814, - 37638.086267060055, - 56998.85004926957, - 340297.67367649154, - 700514.1604227221 - ], - "effective_rank": 6, - "scaled_condition_number": 48.7242741462686, - "weakest_scaled_direction": [ - 0.9448551893371939, - 0.2428921303688794, - 0.03675066658469947, - 0.040726990357932515, - 0.09786300619201982, - -0.18885342720869222 - ] - }, - "forward_reverse": { - "translation_m": 0.013890482176493085, - "rotation_deg": 0.14514813799569015 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.1680287445335408e-15, - "rotation_deg": 4.687489467857236e-14 - }, - { - "translation_m": 2.5341311739065124e-15, - "rotation_deg": 3.490025706945999e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 24, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 17122, - "frame_counter_j": 20855, - "rtk_translation_m": 5.797339988732605, - "rtk_rotation_deg": 169.75977121046614, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9811177484417674, - 0.18855704639162954, - -0.043060468513721195, - -2.6245028066815794 - ], - [ - -0.1877603825968958, - -0.9819709579213345, - -0.021887816842362202, - -6.046882355178831 - ], - [ - -0.046411231610717064, - -0.013389475535746308, - 0.998832678442818, - -0.10855408852029273 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7032, - "backend_objective": 407.0445351718546, - "backend_elapsed_sec": 0.19909390000248095, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 3965, - "objective": 1622.9312881127344 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6037, - "objective": 716.3888694525901 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7032, - "objective": 407.0445351718546 - } - ], - "heldout_symmetric": { - "evaluated": 7879, - "inliers": 5002, - "inlier_ratio": 0.6348521385962685, - "inlier_rmse_m": 0.11831053318180502, - "median_m": 0.1521371508163006, - "p90_m": 1.3051837331469633, - "p95_m": 1.9171985455549974 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20710.81344604819, - 38342.79432659552, - 49297.75345540817, - 73061.35107117619, - 364633.95128815144, - 655932.7777292394 - ], - "effective_rank": 6, - "scaled_condition_number": 31.671029215629257, - "weakest_scaled_direction": [ - -0.5678910730905744, - -0.796779154656965, - -0.02719163962301397, - 0.019533482257423188, - -0.16452183828930608, - 0.12022616329063754 - ] - }, - "forward_reverse": { - "translation_m": 0.00725649124030166, - "rotation_deg": 0.27346756317921195 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5476231888929307e-15, - "rotation_deg": 1.5514880592725393e-14 - }, - { - "translation_m": 2.788986529080262e-15, - "rotation_deg": 2.259705993270636e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 25, - "lidar_time_i": 1784282392.325837, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 17122, - "frame_counter_j": 21471, - "rtk_translation_m": 3.9584300095978864, - "rtk_rotation_deg": 99.81821396908215, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.1818237018454576, - -0.9821180684538241, - -0.04882869098945697, - -2.305445495889172 - ], - [ - 0.9831718295841109, - -0.18246379909891738, - 0.008950727938118012, - -2.6164816428098354 - ], - [ - -0.01770014009680354, - -0.04637953896838138, - 0.9987670616343097, - -0.042555782380241575 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8061, - "backend_objective": 723.654149352357, - "backend_elapsed_sec": 0.0911742000025697, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4167, - "objective": 1127.043719325118 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6654, - "objective": 788.4464718241757 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8061, - "objective": 723.654149352357 - } - ], - "heldout_symmetric": { - "evaluated": 7943, - "inliers": 5635, - "inlier_ratio": 0.7094296865164296, - "inlier_rmse_m": 0.11461231093244224, - "median_m": 0.1266860812666248, - "p90_m": 0.8785748893959482, - "p95_m": 1.3009744703472628 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 46767.93452827792, - 63419.22727269234, - 114316.99745819427, - 197327.26451609196, - 548563.4623924628, - 757971.4760627617 - ], - "effective_rank": 6, - "scaled_condition_number": 16.207076145397426, - "weakest_scaled_direction": [ - -0.7263729595400203, - 0.5322400781352772, - 0.00031534285377282477, - -0.300449456347135, - 0.022249924939196294, - -0.3135885655686801 - ] - }, - "forward_reverse": { - "translation_m": 0.005999722474434507, - "rotation_deg": 0.07369423294061743 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4849604400550063e-06, - "rotation_deg": 2.0430327968283742e-06 - }, - { - "translation_m": 2.7073070733395767e-15, - "rotation_deg": 3.727429573655849e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282614.418045, - "frame_counter_i": 18410, - "frame_counter_j": 19343, - "rtk_translation_m": 2.665930009787955, - "rtk_rotation_deg": 43.65775964817948, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7219205570614048, - 0.6919314699717553, - 0.00784539067715106, - 1.0922648696131512 - ], - [ - -0.6918483353994663, - 0.7219587616679721, - -0.011019403606170765, - -3.1406040799782953 - ], - [ - -0.013288720673507226, - 0.0025273135093058004, - 0.9999085071091688, - 0.06964006745580492 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8142, - "backend_objective": 1234.3177121689323, - "backend_elapsed_sec": 0.10909959999844432, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4338, - "objective": 1175.425677860173 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6644, - "objective": 681.080488511983 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8142, - "objective": 1234.3177121689323 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5977, - "inlier_ratio": 0.7387220368310469, - "inlier_rmse_m": 0.11520069835112393, - "median_m": 0.12019105796620244, - "p90_m": 0.6953242320612882, - "p95_m": 1.050094131806798 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 46140.67294854187, - 113395.7322843758, - 213814.09550776437, - 264414.66107346705, - 595953.9424334377, - 739415.9231262935 - ], - "effective_rank": 6, - "scaled_condition_number": 16.025252253059314, - "weakest_scaled_direction": [ - 0.035978967776125, - 0.09232038069703316, - -0.003760053758143683, - -0.99467079003564, - 0.023334703483338794, - 0.01593217639487336 - ] - }, - "forward_reverse": { - "translation_m": 0.0021484382611444506, - "rotation_deg": 0.09312757978022868 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0274250349872947e-15, - "rotation_deg": 5.166217357201134e-15 - }, - { - "translation_m": 8.618765454229259e-16, - "rotation_deg": 2.2338469708649284e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 18410, - "frame_counter_j": 20027, - "rtk_translation_m": 6.670349114267683, - "rtk_rotation_deg": 75.60554430284907, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.24436370438726612, - 0.9694739353719043, - -0.020166026198825345, - 2.5897912076367744 - ], - [ - -0.9686478021100676, - 0.24308887787406797, - -0.05127604627174069, - -6.929195922481931 - ], - [ - -0.044808653689524615, - 0.0320637815680817, - 0.9984808953936409, - -0.04983887756914136 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 6880, - "backend_objective": 395.22629506667727, - "backend_elapsed_sec": 0.22173710000060964, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 4037, - "objective": 1677.8124494309295 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5971, - "objective": 595.6628801457048 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 6880, - "objective": 395.22629506667727 - } - ], - "heldout_symmetric": { - "evaluated": 8045, - "inliers": 5019, - "inlier_ratio": 0.6238657551274084, - "inlier_rmse_m": 0.11987801174807478, - "median_m": 0.15964974154627096, - "p90_m": 1.1924422703354376, - "p95_m": 1.7953914669449917 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21961.099961712505, - 35352.19315284042, - 44434.67716782579, - 60745.290642263484, - 422428.2313359957, - 708725.8561103218 - ], - "effective_rank": 6, - "scaled_condition_number": 32.271874238810035, - "weakest_scaled_direction": [ - 0.8823713228792739, - 0.33803437184340035, - 0.028220506245232865, - 0.005566686616904023, - 0.07748245271082842, - -0.31673758312205996 - ] - }, - "forward_reverse": { - "translation_m": 0.007927242611182222, - "rotation_deg": 0.08795608522524892 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.171947447016606e-16, - "rotation_deg": 1.0025744583430352e-14 - }, - { - "translation_m": 1.0877919644084146e-15, - "rotation_deg": 3.537012099682432e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 18410, - "frame_counter_j": 20855, - "rtk_translation_m": 4.0761181240750135, - "rtk_rotation_deg": 118.87493116884215, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.48210731401008083, - 0.8755697198980263, - -0.030825369027424124, - 0.5107414721139739 - ], - [ - -0.8747980997925152, - -0.48301248170504174, - -0.037778659538697155, - -4.441086014106092 - ], - [ - -0.04796688834382983, - 0.008752606173491063, - 0.9988105773908195, - -0.038434761087867676 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7385, - "backend_objective": 492.6840049349837, - "backend_elapsed_sec": 0.09386020000238204, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4017, - "objective": 1190.3513306770155 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6235, - "objective": 597.2104797027926 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7385, - "objective": 492.6840049349837 - } - ], - "heldout_symmetric": { - "evaluated": 8054, - "inliers": 5406, - "inlier_ratio": 0.6712192699279861, - "inlier_rmse_m": 0.11172772070549726, - "median_m": 0.13049105050726378, - "p90_m": 1.0512623760988142, - "p95_m": 1.4670069304909048 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34000.22870007506, - 51332.16734236435, - 73869.8353364477, - 118207.92607092683, - 562523.0439376541, - 732936.8484663698 - ], - "effective_rank": 6, - "scaled_condition_number": 21.556821129992922, - "weakest_scaled_direction": [ - -0.46762644517433677, - -0.8781724683732526, - -0.010053832082836769, - 0.06097474891776988, - -0.078771533569528, - 0.010708385443719796 - ] - }, - "forward_reverse": { - "translation_m": 0.04673963175312233, - "rotation_deg": 0.22273623714194987 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.1302434868979906e-12, - "rotation_deg": 7.590828428462755e-11 - }, - { - "translation_m": 6.130624227548357e-12, - "rotation_deg": 7.590555622372597e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 25, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 18410, - "frame_counter_j": 21471, - "rtk_translation_m": 2.626640779558244, - "rtk_rotation_deg": 150.70305401070652, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8715442470095095, - -0.4870917116354646, - -0.05614525768629649, - -1.936816585942209 - ], - [ - 0.4890071656519628, - -0.8718626967214445, - -0.02697091037848085, - -1.9900284150445566 - ], - [ - -0.03581364887387394, - -0.05096177510294897, - 0.9980582548291935, - 0.009200885006098211 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7615, - "backend_objective": 630.9514278965746, - "backend_elapsed_sec": 0.1252849000011338, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4050, - "objective": 1159.2541181177896 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6327, - "objective": 669.2084869876427 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7615, - "objective": 630.9514278965746 - } - ], - "heldout_symmetric": { - "evaluated": 8118, - "inliers": 5677, - "inlier_ratio": 0.699310174919931, - "inlier_rmse_m": 0.11234398811200015, - "median_m": 0.12337833995510551, - "p90_m": 0.9406389120616805, - "p95_m": 1.3194385416076555 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50235.535200086946, - 57616.50559669636, - 93773.2772238529, - 120450.02516814355, - 506017.9817498882, - 770397.8988914583 - ], - "effective_rank": 6, - "scaled_condition_number": 15.335715959290205, - "weakest_scaled_direction": [ - 0.8392339542693569, - -0.470428022827891, - -0.002171715838917393, - 0.18367278969314832, - 0.0230492033428044, - 0.20028022753525643 - ] - }, - "forward_reverse": { - "translation_m": 0.018678960705618183, - "rotation_deg": 0.1734016933410122 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.249571853013791e-15, - "rotation_deg": 9.364652646721899e-15 - }, - { - "translation_m": 1.6625566625485463e-15, - "rotation_deg": 8.90962490323952e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 26, - "lidar_time_i": 1784282521.1221898, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 18410, - "frame_counter_j": 22301, - "rtk_translation_m": 2.086425835169367, - "rtk_rotation_deg": 83.91641671720558, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.10600988867850965, - -0.9928851524064495, - -0.05423078123345443, - -2.686453248640751 - ], - [ - 0.9943296011084952, - 0.10630901331585778, - -0.0026529318177621795, - -0.17620932782547558 - ], - [ - 0.008399277456479401, - -0.05364203406499015, - 0.9985249042059889, - -0.059155813310063886 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8011, - "backend_objective": 693.8085868704294, - "backend_elapsed_sec": 0.11214460000337567, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4325, - "objective": 1348.0314661640668 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6630, - "objective": 726.933341906807 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8011, - "objective": 693.8085868704294 - } - ], - "heldout_symmetric": { - "evaluated": 8103, - "inliers": 5807, - "inlier_ratio": 0.7166481550043194, - "inlier_rmse_m": 0.11091971646336789, - "median_m": 0.11866963272182393, - "p90_m": 0.8546560900586597, - "p95_m": 1.2753273868600694 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 64824.188029488, - 74417.89759646068, - 128426.72435213615, - 144344.76599854397, - 530756.5972497095, - 784985.4469221719 - ], - "effective_rank": 6, - "scaled_condition_number": 12.109452825928004, - "weakest_scaled_direction": [ - 0.6666599538454016, - 0.24263726172680627, - 0.0059981368738075734, - 0.37958353478733803, - 0.55346086304494, - 0.21506534056073914 - ] - }, - "forward_reverse": { - "translation_m": 0.00977162867106615, - "rotation_deg": 0.0631934229127065 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.580397579524694e-06, - "rotation_deg": 2.966876599145002e-05 - }, - { - "translation_m": 3.4115314244809973e-06, - "rotation_deg": 2.776937689748114e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282682.8141525, - "frame_counter_i": 19343, - "frame_counter_j": 20027, - "rtk_translation_m": 4.005228418650323, - "rtk_rotation_deg": 31.947784654669576, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8472282734250743, - 0.5311711811207518, - 0.007837669038207625, - 3.688216404995122 - ], - [ - -0.530372717569916, - 0.8466079267091516, - -0.04426961588645973, - -1.7065207886098472 - ], - [ - -0.03015017689284228, - 0.03334958440546874, - 0.9989888748396116, - 0.07504877067206552 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8076, - "backend_objective": 702.75476398074, - "backend_elapsed_sec": 0.11438759999873582, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4249, - "objective": 1437.0893535588048 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6694, - "objective": 675.6245784853854 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8076, - "objective": 702.75476398074 - } - ], - "heldout_symmetric": { - "evaluated": 7874, - "inliers": 5711, - "inlier_ratio": 0.7252984505969012, - "inlier_rmse_m": 0.11644876240570266, - "median_m": 0.12559382273605466, - "p90_m": 0.8100897955193409, - "p95_m": 1.325661859216763 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44482.10326467668, - 49123.54649386713, - 87711.40579106665, - 192239.8007806176, - 550500.4764714487, - 797825.5835756668 - ], - "effective_rank": 6, - "scaled_condition_number": 17.935878140214236, - "weakest_scaled_direction": [ - -0.8453361437101158, - -0.4855253659307402, - -0.01905454453148178, - 0.10031955771328369, - -0.015806813050512014, - 0.19747146251857922 - ] - }, - "forward_reverse": { - "translation_m": 0.013002087545984397, - "rotation_deg": 0.11470841251550605 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.965068306494546e-16, - "rotation_deg": 9.588964487858306e-15 - }, - { - "translation_m": 8.95090418262362e-16, - "rotation_deg": 8.179500677465726e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 19343, - "frame_counter_j": 20855, - "rtk_translation_m": 1.4231800329066895, - "rtk_rotation_deg": 75.21717152066267, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.25783489903877715, - 0.9661748116409473, - -0.005234327869357972, - 0.46618394606639413 - ], - [ - -0.9652532312439733, - 0.2573430302171511, - -0.04539564265127379, - -1.3466924116515082 - ], - [ - -0.04251310869286354, - 0.016757032829079754, - 0.9989553730973342, - 0.04215897337221628 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8437, - "backend_objective": 902.5644852165073, - "backend_elapsed_sec": 0.1038200000039069, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4337, - "objective": 1174.1320240838352 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7187, - "objective": 1104.84796922368 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8437, - "objective": 902.5644852165073 - } - ], - "heldout_symmetric": { - "evaluated": 7883, - "inliers": 5956, - "inlier_ratio": 0.7555499175440822, - "inlier_rmse_m": 0.1089594430160029, - "median_m": 0.10578378907431588, - "p90_m": 0.6051629555151, - "p95_m": 1.0818350027224624 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 59658.44329912656, - 85168.59325148223, - 125682.99783127634, - 210228.71051244237, - 669686.6614320468, - 860716.4476327386 - ], - "effective_rank": 6, - "scaled_condition_number": 14.427403734239578, - "weakest_scaled_direction": [ - -0.15428157942780082, - 0.026708380982565283, - -0.008302649507831389, - -0.2681359082786029, - -0.9495492801807837, - 0.0432922839021855 - ] - }, - "forward_reverse": { - "translation_m": 0.0044919719825295985, - "rotation_deg": 0.008669004448985662 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5573135061829016e-14, - "rotation_deg": 1.5785644813422326e-13 - }, - { - "translation_m": 1.549907850668595e-14, - "rotation_deg": 1.6070046715274183e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 19343, - "frame_counter_j": 21471, - "rtk_translation_m": 0.9824487562406952, - "rtk_rotation_deg": 165.63918634111403, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9668033522374386, - 0.2528196224005817, - -0.03706098530365002, - -2.9746736857688463 - ], - [ - -0.25058559917200207, - -0.9664722575440158, - -0.0560199329291046, - -1.2674713104881266 - ], - [ - -0.04998135242326642, - -0.04487330973975492, - 0.9977415749997295, - -0.07055428070517192 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7791, - "backend_objective": 592.2131502548845, - "backend_elapsed_sec": 0.12333800000487827, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 18, - "num_inliers": 4161, - "objective": 1451.8631491623144 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6587, - "objective": 728.3597863107123 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7791, - "objective": 592.2131502548845 - } - ], - "heldout_symmetric": { - "evaluated": 7947, - "inliers": 5633, - "inlier_ratio": 0.7088209387190134, - "inlier_rmse_m": 0.11165869814478939, - "median_m": 0.11978290082908663, - "p90_m": 0.9281751461832283, - "p95_m": 1.4517912317289203 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36370.525368980416, - 56508.14273594371, - 78725.24163073627, - 163300.4494046264, - 598518.2948794718, - 851420.0815139217 - ], - "effective_rank": 6, - "scaled_condition_number": 23.409617344710625, - "weakest_scaled_direction": [ - 0.9540918566872878, - -0.2566807233042168, - 0.021396307989543204, - 0.1250819785191461, - 0.042474560030864764, - 0.07691777227250848 - ] - }, - "forward_reverse": { - "translation_m": 0.005265657588642687, - "rotation_deg": 0.10195131255569051 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9466129872826794e-05, - "rotation_deg": 8.107706844091935e-05 - }, - { - "translation_m": 1.946612987271537e-05, - "rotation_deg": 8.107706842650995e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 26, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 19343, - "frame_counter_j": 22301, - "rtk_translation_m": 3.0743977770984916, - "rtk_rotation_deg": 127.57417636538506, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.611617227556335, - -0.78988226066086, - -0.044837275224882414, - -4.782659963293652 - ], - [ - 0.7911032638626728, - -0.6112358852625852, - -0.023373456592692375, - -0.4867185524006974 - ], - [ - -0.008943872881948844, - -0.04976652349274425, - 0.9987208320032772, - -0.12551668962640913 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7430, - "backend_objective": 488.3593273380921, - "backend_elapsed_sec": 0.09648729999753414, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 4194, - "objective": 971.5497914030336 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6377, - "objective": 615.3692190231524 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7430, - "objective": 488.3593273380921 - } - ], - "heldout_symmetric": { - "evaluated": 7932, - "inliers": 5419, - "inlier_ratio": 0.6831820474029249, - "inlier_rmse_m": 0.11509847268437542, - "median_m": 0.13249770875702188, - "p90_m": 1.1312127847258586, - "p95_m": 1.728064679430129 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41015.504174713715, - 50565.34116586249, - 91300.00260572834, - 185965.65028602816, - 422750.596064571, - 740461.3550567983 - ], - "effective_rank": 6, - "scaled_condition_number": 18.05320621935197, - "weakest_scaled_direction": [ - -0.5635457779882261, - -0.5326307475682727, - -0.03140995689480733, - -0.2523779340280646, - -0.4028315082989892, - -0.41444687452273193 - ] - }, - "forward_reverse": { - "translation_m": 0.010313466929779696, - "rotation_deg": 0.02189018950989812 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.008512185982529e-08, - "rotation_deg": 5.162860289385775e-07 - }, - { - "translation_m": 2.3562731337043467e-13, - "rotation_deg": 1.5940744183987593e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 27, - "lidar_time_i": 1784282614.418045, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 19343, - "frame_counter_j": 22832, - "rtk_translation_m": 3.054692363582515, - "rtk_rotation_deg": 96.43768805753649, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.11105936141133146, - -0.9928909061092921, - -0.04281900055321735, - -3.7657405495120875 - ], - [ - 0.9936970624002296, - -0.11028290311388689, - -0.0200955084018292, - -0.7182670529367128 - ], - [ - 0.015230443856375155, - -0.04478090939498908, - 0.998880725479121, - -0.048434989336104496 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7872, - "backend_objective": 674.0822302728145, - "backend_elapsed_sec": 0.09539320000476437, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4163, - "objective": 1142.904837086234 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6412, - "objective": 654.4075700412851 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7872, - "objective": 674.0822302728145 - } - ], - "heldout_symmetric": { - "evaluated": 7943, - "inliers": 5658, - "inlier_ratio": 0.712325317889966, - "inlier_rmse_m": 0.11297739003609018, - "median_m": 0.12230824460828289, - "p90_m": 0.9244032506879108, - "p95_m": 1.5043599686221012 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51095.73711929689, - 58324.69214314388, - 127264.95363964487, - 194899.3452349152, - 475710.46193595085, - 744489.7621380414 - ], - "effective_rank": 6, - "scaled_condition_number": 14.570486778570737, - "weakest_scaled_direction": [ - 0.21205084554134654, - 0.46222081230733225, - 0.027852060717769897, - 0.07414576847826533, - 0.8307416042831952, - 0.212088222725058 - ] - }, - "forward_reverse": { - "translation_m": 0.006473104665270118, - "rotation_deg": 0.07627008321159866 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2779626727101132e-15, - "rotation_deg": 5.8494627683542094e-15 - }, - { - "translation_m": 1.0695546869292897e-13, - "rotation_deg": 1.2818532378045082e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282765.6112185, - "frame_counter_i": 20027, - "frame_counter_j": 20855, - "rtk_translation_m": 2.6253440212817054, - "rtk_rotation_deg": 43.26938686599312, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7316385219835515, - 0.6816856721831934, - -0.003117288865629237, - -2.928569573553622 - ], - [ - -0.6816926156029554, - 0.731634035323485, - -0.0026107831536129854, - -1.4137194175023107 - ], - [ - 0.0005009811630340623, - 0.004035182328129723, - 0.9999917331265555, - -0.06016299122785323 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8664, - "backend_objective": 718.4382749860787, - "backend_elapsed_sec": 0.09146969999710564, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4276, - "objective": 1060.3558447311034 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7048, - "objective": 907.9673301968234 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8664, - "objective": 718.4382749860787 - } - ], - "heldout_symmetric": { - "evaluated": 7837, - "inliers": 6172, - "inlier_ratio": 0.787546254944494, - "inlier_rmse_m": 0.11112536909525574, - "median_m": 0.10446503721484761, - "p90_m": 0.5450621875516725, - "p95_m": 1.001418134214043 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 59818.112315563776, - 70156.99926867911, - 104752.68740716732, - 343999.48350022855, - 544123.459767399, - 817579.969940869 - ], - "effective_rank": 6, - "scaled_condition_number": 13.667766137918514, - "weakest_scaled_direction": [ - -0.08181946336381639, - 0.18565903818231316, - -0.021613276934704294, - -0.28361740332044505, - -0.9302845462486405, - 0.11180784749269009 - ] - }, - "forward_reverse": { - "translation_m": 0.003984385308883342, - "rotation_deg": 0.012875657690538275 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.568339948907339e-16, - "rotation_deg": 3.980573504125873e-15 - }, - { - "translation_m": 5.6661939073952674e-14, - "rotation_deg": 4.483416428860257e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 20027, - "frame_counter_j": 21471, - "rtk_translation_m": 4.30404511575867, - "rtk_rotation_deg": 133.69140168644446, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.684775479697797, - 0.7280331457171291, - -0.03240804131499784, - -5.885911399550697 - ], - [ - -0.7275609859606644, - -0.6855216898305089, - -0.026739941657930238, - -3.183251160291944 - ], - [ - -0.04168397908786969, - 0.005267970116293473, - 0.999116957306929, - -0.14256531141547005 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7334, - "backend_objective": 441.10293254883305, - "backend_elapsed_sec": 0.11134479999600444, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 18, - "num_inliers": 3889, - "objective": 2096.0155731973537 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6155, - "objective": 636.912425900376 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7334, - "objective": 441.10293254883305 - } - ], - "heldout_symmetric": { - "evaluated": 7901, - "inliers": 5404, - "inlier_ratio": 0.6839640551828883, - "inlier_rmse_m": 0.11561487899989795, - "median_m": 0.13320342154151646, - "p90_m": 1.059724966903968, - "p95_m": 1.8630882686324364 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18277.081943360936, - 40037.65569659247, - 48113.94852960326, - 169467.63266558063, - 366879.0550574965, - 735162.1195192076 - ], - "effective_rank": 6, - "scaled_condition_number": 40.22316701306096, - "weakest_scaled_direction": [ - 0.9303106732966971, - -0.35446008300782333, - 0.021250207612046466, - 0.03862650032102158, - 0.061568078689399515, - 0.05608827453420191 - ] - }, - "forward_reverse": { - "translation_m": 0.009663940236368565, - "rotation_deg": 0.2587163051792124 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6700812920971042e-05, - "rotation_deg": 0.00010070947164169274 - }, - { - "translation_m": 2.0307144547971162e-15, - "rotation_deg": 2.696066277988921e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 20027, - "frame_counter_j": 22301, - "rtk_translation_m": 6.580252552934289, - "rtk_rotation_deg": 159.52196102005493, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.937652640941694, - -0.3436423846450911, - -0.05212903615550391, - -7.83285756373407 - ], - [ - 0.3445889421983096, - -0.9386990399126087, - -0.010127851785875731, - -3.4825275139221468 - ], - [ - -0.04545311705171078, - -0.027459496400734956, - 0.9985889996428473, - -0.2362012597280001 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6760, - "backend_objective": 382.8073713454754, - "backend_elapsed_sec": 0.11480090000259224, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3775, - "objective": 1439.0183504849776 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5722, - "objective": 492.357069028601 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6760, - "objective": 382.8073713454754 - } - ], - "heldout_symmetric": { - "evaluated": 7886, - "inliers": 4901, - "inlier_ratio": 0.6214811057570377, - "inlier_rmse_m": 0.12356096223549605, - "median_m": 0.16384331155514473, - "p90_m": 1.5538134695314363, - "p95_m": 2.317860782035522 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 11904.225853867052, - 32315.599031740323, - 39318.095670072995, - 79508.85118857495, - 308004.06194042746, - 704586.1183803094 - ], - "effective_rank": 6, - "scaled_condition_number": 59.18789907295204, - "weakest_scaled_direction": [ - 0.7950948314396045, - 0.5556142085478614, - 0.02281207092996104, - -0.015520908322619075, - 0.08576110552205275, - 0.22583357563064646 - ] - }, - "forward_reverse": { - "translation_m": 0.03346639663911815, - "rotation_deg": 0.040359288659068966 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.187061866953045e-15, - "rotation_deg": 2.7889140701982987e-14 - }, - { - "translation_m": 8.474018412808198e-08, - "rotation_deg": 9.464229819866394e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 27, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 20027, - "frame_counter_j": 22832, - "rtk_translation_m": 6.261292051742304, - "rtk_rotation_deg": 128.3854727122061, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6218964522934143, - -0.7817651851253367, - -0.04569461621255804, - -6.839632222855389 - ], - [ - 0.7827131512584892, - -0.6223631998729469, - -0.004916329007710244, - -3.127634648147262 - ], - [ - -0.02459523270616417, - -0.03882322461948075, - 0.9989433576325911, - -0.18350709226514308 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6864, - "backend_objective": 360.49708262335116, - "backend_elapsed_sec": 0.10761560000537429, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3725, - "objective": 1110.052621917542 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5735, - "objective": 496.84407211054696 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6864, - "objective": 360.49708262335116 - } - ], - "heldout_symmetric": { - "evaluated": 7897, - "inliers": 5085, - "inlier_ratio": 0.6439154109155375, - "inlier_rmse_m": 0.11883308044324468, - "median_m": 0.1501234605509406, - "p90_m": 1.4004608509008665, - "p95_m": 2.100443424706241 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14995.327513467042, - 31055.449294812966, - 41523.3079852468, - 127499.94617471834, - 294776.29218309023, - 723568.8459938181 - ], - "effective_rank": 6, - "scaled_condition_number": 48.252953818047224, - "weakest_scaled_direction": [ - 0.26650340064692807, - 0.9520240679412312, - 0.01349180377962655, - -0.061366095440010995, - 0.023494729288998782, - 0.13463388414923647 - ] - }, - "forward_reverse": { - "translation_m": 0.01363202571969651, - "rotation_deg": 0.268813724284828 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4133820648210267e-06, - "rotation_deg": 1.4694369969203062e-05 - }, - { - "translation_m": 4.550645659709847e-12, - "rotation_deg": 1.0268685170595407e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 28, - "lidar_time_i": 1784282682.8141525, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 20027, - "frame_counter_j": 23867, - "rtk_translation_m": 10.83543880539923, - "rtk_rotation_deg": 37.57580831192121, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7864106380412907, - -0.6169764078230248, - -0.029973664528813723, - -10.5690840037096 - ], - [ - 0.6176988190545919, - 0.7856775097616834, - 0.034044376822604715, - -2.588662588597491 - ], - [ - 0.0025450567868462934, - -0.0452875572809694, - 0.998970750243212, - -0.3615413912046347 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 5758, - "backend_objective": 362.4569520335848, - "backend_elapsed_sec": 0.2575600999989547, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 18, - "num_inliers": 3558, - "objective": 1464.8678508444634 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 5046, - "objective": 536.6596144729192 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 5758, - "objective": 362.4569520335848 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 4377, - "inlier_ratio": 0.5551750380517504, - "inlier_rmse_m": 0.13104613123848732, - "median_m": 0.2058536041837457, - "p90_m": 1.6577513661084293, - "p95_m": 2.289017549809099 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14390.235422471975, - 23787.63789576247, - 32804.45229613129, - 119277.17490529893, - 263333.46922642423, - 633292.3467836828 - ], - "effective_rank": 6, - "scaled_condition_number": 44.00847715074386, - "weakest_scaled_direction": [ - 0.9404503190480624, - -0.3082908160509529, - 0.003962202000027104, - 0.12476055944871436, - 0.0701353762029909, - 0.0031785070796152923 - ] - }, - "forward_reverse": { - "translation_m": 0.01592501575703795, - "rotation_deg": 0.1925228188054137 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.4378974214416385e-15, - "rotation_deg": 5.956130244946421e-14 - }, - { - "translation_m": 2.5669031001846587e-15, - "rotation_deg": 2.747411973876145e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282827.209564, - "frame_counter_i": 20855, - "frame_counter_j": 21471, - "rtk_translation_m": 2.0155105379126432, - "rtk_rotation_deg": 90.4220148204513, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.005222484454047837, - 0.9999723179739274, - -0.005299900185628911, - -0.9563258472367476 - ], - [ - -0.9995526553564481, - -0.005376224503562952, - -0.029420832414470126, - -3.313175791022872 - ], - [ - -0.029448511439464555, - 0.005143879463759797, - 0.9995530629626734, - -0.03525307801587053 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8347, - "backend_objective": 642.9366409945478, - "backend_elapsed_sec": 0.11560399999871152, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4227, - "objective": 2610.2838075402897 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6909, - "objective": 720.8489607781735 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8347, - "objective": 642.9366409945478 - } - ], - "heldout_symmetric": { - "evaluated": 7910, - "inliers": 6020, - "inlier_ratio": 0.7610619469026548, - "inlier_rmse_m": 0.10446971824743242, - "median_m": 0.1007578122622833, - "p90_m": 0.6529933155559581, - "p95_m": 1.1275482682900053 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34674.42613312141, - 55462.82668670179, - 107294.12450985223, - 169601.63868303315, - 479294.70292038884, - 773203.0297448203 - ], - "effective_rank": 6, - "scaled_condition_number": 22.29894236104597, - "weakest_scaled_direction": [ - 0.9267818181191543, - -0.3642850835854793, - 0.021605440889195655, - 0.04819804176088377, - 0.06150820221557558, - 0.04241148706992467 - ] - }, - "forward_reverse": { - "translation_m": 0.01721789520038266, - "rotation_deg": 0.09266069416139829 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.862323494706137e-06, - "rotation_deg": 1.9393338023955322e-05 - }, - { - "translation_m": 1.4060466165506383e-15, - "rotation_deg": 5.568188765909471e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 20855, - "frame_counter_j": 22301, - "rtk_translation_m": 4.344602404326578, - "rtk_rotation_deg": 157.20865211395216, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9212102577280694, - 0.38836016947644203, - -0.02341025033640561, - -2.1853134081267176 - ], - [ - -0.3874191809609859, - -0.9211798663075629, - -0.036524404623475414, - -4.861845408098207 - ], - [ - -0.03574967524471575, - -0.024577076185134158, - 0.9990585208315311, - -0.03620244623781051 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7624, - "backend_objective": 540.158487226316, - "backend_elapsed_sec": 0.11349199999676785, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 4067, - "objective": 2114.4343582170354 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6370, - "objective": 553.3364988358043 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7624, - "objective": 540.158487226316 - } - ], - "heldout_symmetric": { - "evaluated": 7895, - "inliers": 5516, - "inlier_ratio": 0.6986700443318556, - "inlier_rmse_m": 0.11795525471114342, - "median_m": 0.13465463483159976, - "p90_m": 1.1040015867883632, - "p95_m": 1.7109335211240762 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 23809.22476255567, - 56967.99719319072, - 77761.8586939183, - 233931.45213473478, - 420178.787628248, - 722705.5242172445 - ], - "effective_rank": 6, - "scaled_condition_number": 30.354013262701024, - "weakest_scaled_direction": [ - 0.7246093351546515, - 0.6835687376467154, - 0.023695802939696097, - -0.04439918338332187, - 0.05577116317410626, - -0.04507650291398417 - ] - }, - "forward_reverse": { - "translation_m": 0.0239438468814135, - "rotation_deg": 0.2700005297192175 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.541430110368098e-08, - "rotation_deg": 2.8007577805020575e-07 - }, - { - "translation_m": 3.541430081316921e-08, - "rotation_deg": 2.800757954660126e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 20855, - "frame_counter_j": 22832, - "rtk_translation_m": 4.194437499675352, - "rtk_rotation_deg": 171.65485957819877, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9886190264470782, - -0.148160054509517, - -0.026096336803643722, - -1.693947908745894 - ], - [ - 0.14887852744115113, - -0.9884547007756772, - -0.028151173713006503, - -3.9162560866104426 - ], - [ - -0.02162416735476102, - -0.031715970144429846, - 0.9992629747088656, - -0.1371324446218627 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7777, - "backend_objective": 637.7690379445443, - "backend_elapsed_sec": 0.10812219999934314, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 4073, - "objective": 1288.5098998568735 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6388, - "objective": 747.1045646805275 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7777, - "objective": 637.7690379445443 - } - ], - "heldout_symmetric": { - "evaluated": 7906, - "inliers": 5719, - "inlier_ratio": 0.7233746521629142, - "inlier_rmse_m": 0.11505806966234582, - "median_m": 0.12376002252011303, - "p90_m": 0.8664774088506898, - "p95_m": 1.4852122368232208 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 30500.801507336088, - 51236.66393006205, - 102042.46775737686, - 201960.20851744784, - 465296.0256839811, - 738693.6981030428 - ], - "effective_rank": 6, - "scaled_condition_number": 24.218829066684407, - "weakest_scaled_direction": [ - 0.33062292489026934, - 0.9267045673075242, - 0.020433273969173073, - -0.06387654473028298, - 0.08084344380966146, - 0.14447744602391363 - ] - }, - "forward_reverse": { - "translation_m": 0.0071603040929797065, - "rotation_deg": 0.1144565168286882 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.245503975015694e-15, - "rotation_deg": 2.4642849864535424e-14 - }, - { - "translation_m": 1.6241991748877272e-06, - "rotation_deg": 1.310480562167213e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 28, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 20855, - "frame_counter_j": 23867, - "rtk_translation_m": 8.235813904401468, - "rtk_rotation_deg": 80.84519517791432, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.15431772192420115, - -0.9871712612951672, - -0.04097488954266585, - -4.794033888365454 - ], - [ - 0.9879365798398297, - 0.1536287364866755, - 0.019481415243439177, - -6.081846335285466 - ], - [ - -0.01293657274955989, - -0.043486919854323035, - 0.9989702362368356, - -0.1530456526263188 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6470, - "backend_objective": 363.6261667407633, - "backend_elapsed_sec": 0.10693129999708617, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3884, - "objective": 2667.924813596058 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5552, - "objective": 615.1479326852287 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6470, - "objective": 363.6261667407633 - } - ], - "heldout_symmetric": { - "evaluated": 7893, - "inliers": 4882, - "inlier_ratio": 0.618522741669834, - "inlier_rmse_m": 0.1218895746871147, - "median_m": 0.16543013169480736, - "p90_m": 1.3165359598845314, - "p95_m": 1.9653233373028827 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18157.43226974018, - 36033.513148082304, - 51849.87927593188, - 109996.41705729572, - 339131.2684722997, - 627490.9800866216 - ], - "effective_rank": 6, - "scaled_condition_number": 34.55835443937473, - "weakest_scaled_direction": [ - 0.9055466755786573, - -0.3488991912370416, - 0.0021108337849463647, - 0.07864323282329364, - 0.06764790584748816, - 0.21791998496893933 - ] - }, - "forward_reverse": { - "translation_m": 0.008956300116613691, - "rotation_deg": 0.24319664279778394 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.0245584642661925e-16, - "rotation_deg": 1.999964601359078e-15 - }, - { - "translation_m": 9.751059499069721e-16, - "rotation_deg": 8.984477619489771e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 29, - "lidar_time_i": 1784282765.6112185, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 20855, - "frame_counter_j": 24538, - "rtk_translation_m": 2.7255497122534083, - "rtk_rotation_deg": 57.0551252080454, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5492994771645193, - -0.8350533092318384, - -0.030920141133914003, - -1.5962475842101014 - ], - [ - 0.835619505605708, - 0.5490602342006184, - 0.016519717637853582, - -1.4388253228181322 - ], - [ - 0.0031821750514377817, - -0.03491174530895836, - 0.9993853329929472, - -0.0671206181838254 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8433, - "backend_objective": 824.9648690027547, - "backend_elapsed_sec": 0.11201359999540728, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4425, - "objective": 924.2696801690141 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6992, - "objective": 1016.9744274360163 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8433, - "objective": 824.9648690027547 - } - ], - "heldout_symmetric": { - "evaluated": 7868, - "inliers": 6008, - "inlier_ratio": 0.7635993899339095, - "inlier_rmse_m": 0.11147922533242269, - "median_m": 0.11133949221761885, - "p90_m": 0.6363788561688158, - "p95_m": 1.1544276761141714 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68798.17806470545, - 71680.69275126129, - 134728.44625667384, - 226982.9615513413, - 630508.9332915957, - 796168.6854993983 - ], - "effective_rank": 6, - "scaled_condition_number": 11.572525725181164, - "weakest_scaled_direction": [ - 0.67519199227294, - -0.0049714678879932, - 0.0011275478599908938, - 0.6805796161958426, - 0.27794183514429827, - -0.0604111662584001 - ] - }, - "forward_reverse": { - "translation_m": 0.02246832420061709, - "rotation_deg": 0.4519372330281508 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0057567076787437e-15, - "rotation_deg": 2.3591354183974442e-14 - }, - { - "translation_m": 3.128387061314213e-15, - "rotation_deg": 1.7069159521298948e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784282910.2059953, - "frame_counter_i": 21471, - "frame_counter_j": 22301, - "rtk_translation_m": 2.340922525153354, - "rtk_rotation_deg": 66.78663729350096, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3932904644892917, - 0.9194089903278928, - -0.0031175384589049297, - 1.5689161645386143 - ], - [ - -0.9191996616647784, - 0.3931231408593706, - -0.022938572671819122, - -1.2203527716368774 - ], - [ - -0.019864353429045613, - 0.011887162197473456, - 0.9997320155110254, - 0.038559781043645484 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8882, - "backend_objective": 959.1946737080699, - "backend_elapsed_sec": 0.0923356999992393, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4504, - "objective": 819.6259334838549 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7248, - "objective": 871.7847638951343 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8882, - "objective": 959.1946737080699 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 6508, - "inlier_ratio": 0.8176906646563639, - "inlier_rmse_m": 0.1076748622762494, - "median_m": 0.09682656097890656, - "p90_m": 0.45264143343176133, - "p95_m": 0.7630922462694615 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 82801.50286335814, - 92122.57768093605, - 208019.04720607624, - 296187.9827635429, - 562504.1468562767, - 844105.0213405968 - ], - "effective_rank": 6, - "scaled_condition_number": 10.194320056407282, - "weakest_scaled_direction": [ - 0.7394522741684544, - 0.32743622752806295, - 0.009778110461861132, - 0.29967203729425274, - 0.459836772665614, - 0.21129849089255553 - ] - }, - "forward_reverse": { - "translation_m": 0.011727583881002021, - "rotation_deg": 0.04299213457608308 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8638296154205614e-06, - "rotation_deg": 3.6902488615193315e-06 - }, - { - "translation_m": 4.47545209131181e-16, - "rotation_deg": 9.875181038613888e-16 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 21471, - "frame_counter_j": 22832, - "rtk_translation_m": 2.187150933555911, - "rtk_rotation_deg": 97.92312560134954, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.14279103728398043, - 0.989747636072606, - -0.003215052107463622, - 0.6180823036166979 - ], - [ - -0.9892921924933832, - -0.14282292014640846, - -0.03004282530801442, - -0.7324484491997415 - ], - [ - -0.030193998459960354, - -0.0011092202402996421, - 0.9995434418210439, - -0.011549303017470177 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9377, - "backend_objective": 941.220445781815, - "backend_elapsed_sec": 0.1000041000006604, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4393, - "objective": 754.8221197075133 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 7322, - "objective": 922.7663547989258 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9377, - "objective": 941.220445781815 - } - ], - "heldout_symmetric": { - "evaluated": 7970, - "inliers": 6781, - "inlier_ratio": 0.8508155583437892, - "inlier_rmse_m": 0.10177690901936605, - "median_m": 0.08794780126840006, - "p90_m": 0.3643641291512237, - "p95_m": 0.5743991799426108 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 92787.75565299024, - 106219.81244868562, - 228951.32827375113, - 349764.53764673247, - 725644.6539066491, - 876603.7121599698 - ], - "effective_rank": 6, - "scaled_condition_number": 9.447407214356089, - "weakest_scaled_direction": [ - 0.3220058996415483, - 0.48849673458555753, - -0.008189205777130075, - 0.05994790765047574, - 0.7907245223301784, - 0.16963801448397683 - ] - }, - "forward_reverse": { - "translation_m": 0.004921098494284399, - "rotation_deg": 0.04722324529000337 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3567190127249392e-15, - "rotation_deg": 4.199795522781451e-15 - }, - { - "translation_m": 1.2667805563364376e-15, - "rotation_deg": 5.016858305749333e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 21471, - "frame_counter_j": 23867, - "rtk_translation_m": 6.688406442287195, - "rtk_rotation_deg": 171.26720999836604, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9877879824853878, - -0.14672953398443556, - -0.05239604483314723, - 2.7953678406719913 - ], - [ - 0.14918143939712175, - -0.9877198783097575, - -0.04641486972039104, - -3.815886411643417 - ], - [ - -0.04494218282248763, - -0.05366456790535228, - 0.9975471489381713, - -0.022524949054600122 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7077, - "backend_objective": 602.0223937352076, - "backend_elapsed_sec": 0.18108309999661287, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 4017, - "objective": 1665.7813157878095 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5912, - "objective": 475.6816693003514 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7077, - "objective": 602.0223937352076 - } - ], - "heldout_symmetric": { - "evaluated": 7957, - "inliers": 5214, - "inlier_ratio": 0.6552720874701521, - "inlier_rmse_m": 0.1158307449607044, - "median_m": 0.14052727692433775, - "p90_m": 1.046656111199863, - "p95_m": 1.4663672706284545 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42008.113319588956, - 58290.093258571964, - 90526.17420147586, - 126748.87783217231, - 415694.23578957136, - 708118.2676005148 - ], - "effective_rank": 6, - "scaled_condition_number": 16.856702471098828, - "weakest_scaled_direction": [ - -0.7230757778315811, - 0.559665372691361, - -0.008073719685306258, - -0.3487159010619288, - -0.03514843026209357, - 0.2025653311171864 - ] - }, - "forward_reverse": { - "translation_m": 0.010027166778796438, - "rotation_deg": 0.069841684352646 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.9321820064161137e-15, - "rotation_deg": 7.175657641913215e-15 - }, - { - "translation_m": 8.096574468677559e-11, - "rotation_deg": 2.694950365171778e-09 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 29, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 21471, - "frame_counter_j": 24538, - "rtk_translation_m": 1.411474020521721, - "rtk_rotation_deg": 147.47714002849685, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8381797942096519, - -0.5430247749723809, - -0.050781161318546535, - -1.8710702098459255 - ], - [ - 0.544908870154576, - -0.8377226893342556, - -0.03598637244077235, - -0.6438482457794455 - ], - [ - -0.022999039230566797, - -0.05783415548598485, - 0.9980612479470856, - -0.05088904032648747 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8228, - "backend_objective": 589.2497329740725, - "backend_elapsed_sec": 0.11608520000299904, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 4384, - "objective": 953.9721877762931 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6859, - "objective": 687.1103921467825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8228, - "objective": 589.2497329740725 - } - ], - "heldout_symmetric": { - "evaluated": 7932, - "inliers": 5897, - "inlier_ratio": 0.7434442763489663, - "inlier_rmse_m": 0.11227320270489505, - "median_m": 0.11329306266061136, - "p90_m": 0.7280985939722301, - "p95_m": 1.1824613458158708 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41758.52113708298, - 61266.82169026914, - 88446.94000511957, - 165042.60242052496, - 596453.2194718086, - 802070.4042351833 - ], - "effective_rank": 6, - "scaled_condition_number": 19.207346965238134, - "weakest_scaled_direction": [ - 0.9638496414109743, - 0.22986328444560739, - 0.02534005200594493, - 0.01712673692169194, - 0.08302478720781598, - 0.10162765652942089 - ] - }, - "forward_reverse": { - "translation_m": 0.005744598995027529, - "rotation_deg": 0.30413185830684 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6997315992753952e-15, - "rotation_deg": 1.4526667320351084e-14 - }, - { - "translation_m": 1.971963787771864e-07, - "rotation_deg": 1.2218195962946332e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 30, - "lidar_time_i": 1784282827.209564, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 21471, - "frame_counter_j": 25032, - "rtk_translation_m": 0.5324917816481396, - "rtk_rotation_deg": 118.09183853064393, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4735811450423778, - -0.8795470950122964, - -0.04601963402484206, - -2.2283150465270585 - ], - [ - 0.8804299494286093, - -0.47417117296958516, - 0.0021915459804320928, - 0.6489768993443397 - ], - [ - -0.023748751745865295, - -0.03947918920238874, - 0.9989381314227799, - -0.05769870645152169 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8644, - "backend_objective": 751.1823040892174, - "backend_elapsed_sec": 0.10671250000450527, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4370, - "objective": 1006.5047570988388 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 7181, - "objective": 730.001608170084 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8644, - "objective": 751.1823040892174 - } - ], - "heldout_symmetric": { - "evaluated": 7920, - "inliers": 6325, - "inlier_ratio": 0.7986111111111112, - "inlier_rmse_m": 0.1061010900656728, - "median_m": 0.09645206395342157, - "p90_m": 0.5158664627158488, - "p95_m": 0.8943497785416119 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51175.24596840906, - 68015.71030211762, - 139145.46040838526, - 291489.912757213, - 642087.8464369182, - 767376.9286384654 - ], - "effective_rank": 6, - "scaled_condition_number": 14.995080416656407, - "weakest_scaled_direction": [ - 0.7185097906495923, - 0.6504079608686344, - 0.024949855814964218, - 0.035794149307638794, - 0.1480796647079181, - -0.1920465090792592 - ] - }, - "forward_reverse": { - "translation_m": 0.004651476537899485, - "rotation_deg": 0.06337779258524685 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1624044754869987e-05, - "rotation_deg": 1.0325528650197526e-05 - }, - { - "translation_m": 1.697684268052296e-07, - "rotation_deg": 8.472134140412767e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784282963.3037353, - "frame_counter_i": 22301, - "frame_counter_j": 22832, - "rtk_translation_m": 0.6349061963265976, - "rtk_rotation_deg": 31.136488307848563, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8536619463221716, - 0.5208026472127358, - 0.005087637727674223, - -0.8037600458537668 - ], - [ - -0.5208126259136155, - 0.8536706605605496, - 0.0007822960305142633, - -0.6659702135135269 - ], - [ - -0.003935745216080582, - -0.0033175223166561035, - 0.99998675188988, - 0.0006824686145608779 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9926, - "backend_objective": 2043.5058867053008, - "backend_elapsed_sec": 0.09482869999919785, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4473, - "objective": 805.4509019810005 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7569, - "objective": 900.4056552192066 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9926, - "objective": 2043.5058867053008 - } - ], - "heldout_symmetric": { - "evaluated": 7955, - "inliers": 7029, - "inlier_ratio": 0.8835952231301069, - "inlier_rmse_m": 0.10164781558403184, - "median_m": 0.08085473414709034, - "p90_m": 0.2788910789553824, - "p95_m": 0.48275665334578555 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 101559.17043150349, - 152466.52854812608, - 328860.8153645765, - 637076.7114674916, - 749138.2809763459, - 887795.6040643979 - ], - "effective_rank": 6, - "scaled_condition_number": 8.741658683232068, - "weakest_scaled_direction": [ - 0.15909744870928347, - 0.11522601401506771, - -0.04108642498941928, - 0.11146551129835221, - 0.9720575611842073, - 0.04901439304522955 - ] - }, - "forward_reverse": { - "translation_m": 0.0010243697887392141, - "rotation_deg": 0.04630474119881922 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5350455729059196e-08, - "rotation_deg": 1.4479858619697106e-07 - }, - { - "translation_m": 2.5350455740888726e-08, - "rotation_deg": 1.4479858841447727e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 22301, - "frame_counter_j": 23867, - "rtk_translation_m": 5.008419104260455, - "rtk_rotation_deg": 121.94615270813352, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5240862806538904, - 0.8516244167625724, - -0.008332058819981562, - 2.880937414641506 - ], - [ - -0.8499886890974395, - -0.5236431455249201, - -0.05759413643057307, - 0.11406320303437172 - ], - [ - -0.05341159833582459, - -0.023102140995492904, - 0.9983053101354494, - 0.03248515064220392 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7844, - "backend_objective": 1104.6574358849996, - "backend_elapsed_sec": 0.11934219999966444, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 4306, - "objective": 891.8769928148329 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6593, - "objective": 687.4315810117731 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7844, - "objective": 1104.6574358849996 - } - ], - "heldout_symmetric": { - "evaluated": 7942, - "inliers": 5570, - "inlier_ratio": 0.7013346764039284, - "inlier_rmse_m": 0.1156303654422143, - "median_m": 0.12775161732661877, - "p90_m": 0.754871881703839, - "p95_m": 1.1698787741427545 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 72046.8444235557, - 92184.04980428005, - 174146.77935550862, - 218587.06797693414, - 522338.0169982444, - 749049.0010890709 - ], - "effective_rank": 6, - "scaled_condition_number": 10.39669408260953, - "weakest_scaled_direction": [ - 0.11111210387995367, - -0.23795490003675307, - 0.013874358514405511, - 0.9568428690008515, - -0.10599503753524517, - -0.0636855097789378 - ] - }, - "forward_reverse": { - "translation_m": 0.016692399239017493, - "rotation_deg": 0.1408617368634082 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.148843527161987e-06, - "rotation_deg": 1.1829201429159507e-05 - }, - { - "translation_m": 2.458953279334877e-15, - "rotation_deg": 2.838149824475859e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 22301, - "frame_counter_j": 24538, - "rtk_translation_m": 2.224643201350574, - "rtk_rotation_deg": 145.73622267800252, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8298183889667279, - 0.5578693886901691, - -0.013534640561294269, - -1.872538964358695 - ], - [ - -0.5566627342094188, - -0.8292354213180542, - -0.04995214083462805, - -2.93194450188444 - ], - [ - -0.039090173639412445, - -0.03391697501143836, - 0.9986599006322997, - -0.09874973372844144 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8048, - "backend_objective": 776.7534173434285, - "backend_elapsed_sec": 0.11052619999827584, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 4291, - "objective": 1168.8741009019384 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6661, - "objective": 775.6420783434858 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8048, - "objective": 776.7534173434285 - } - ], - "heldout_symmetric": { - "evaluated": 7917, - "inliers": 5744, - "inlier_ratio": 0.7255273462170014, - "inlier_rmse_m": 0.11343814488049828, - "median_m": 0.11916187055826276, - "p90_m": 0.9369048813897216, - "p95_m": 1.5112765943685864 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50862.33133943675, - 59942.01936876795, - 101071.9131168184, - 152509.97268507312, - 452211.13763264247, - 720816.8028809017 - ], - "effective_rank": 6, - "scaled_condition_number": 14.171918272295303, - "weakest_scaled_direction": [ - 0.37012938492842545, - -0.06916503141179607, - 0.0006356713714462137, - 0.8694802819778074, - 0.29724825066326593, - -0.11776056000902373 - ] - }, - "forward_reverse": { - "translation_m": 0.0030631045126193056, - "rotation_deg": 0.10499072900350268 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.428873099349592e-15, - "rotation_deg": 2.1925220672754382e-14 - }, - { - "translation_m": 2.194940801758818e-06, - "rotation_deg": 1.028382273903599e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 30, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 22301, - "frame_counter_j": 25032, - "rtk_translation_m": 2.6736935848107626, - "rtk_rotation_deg": 175.1215241758588, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9953335616810653, - 0.09055680341207573, - -0.0333251608709041, - -3.212196948194801 - ], - [ - -0.08977856384982331, - -0.9956687956592172, - -0.024154892332332024, - -2.757410426490333 - ], - [ - -0.03536821262586163, - -0.0210502899341086, - 0.999152628395353, - -0.06427819362861412 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7859, - "backend_objective": 577.1606717207875, - "backend_elapsed_sec": 0.10045569999783766, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4192, - "objective": 1054.44320095977 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6738, - "objective": 571.9620381382674 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7859, - "objective": 577.1606717207875 - } - ], - "heldout_symmetric": { - "evaluated": 7905, - "inliers": 5750, - "inlier_ratio": 0.7273877292852625, - "inlier_rmse_m": 0.11178149175643984, - "median_m": 0.11486229890008998, - "p90_m": 0.9026862092015043, - "p95_m": 1.5300165160626082 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36480.24021640766, - 54914.931009515916, - 84112.89713517294, - 216219.57864769292, - 472676.49016378896, - 736501.1185425993 - ], - "effective_rank": 6, - "scaled_condition_number": 20.18904245623208, - "weakest_scaled_direction": [ - -0.7832776666765026, - -0.6053419783894618, - -0.014829979270937205, - 0.04619295039531547, - -0.05263400654367961, - 0.12211932889229789 - ] - }, - "forward_reverse": { - "translation_m": 0.002906139936114469, - "rotation_deg": 0.06343916895540856 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.1556331817012896e-15, - "rotation_deg": 1.428043541376894e-14 - }, - { - "translation_m": 1.9215600145140428e-15, - "rotation_deg": 8.070190727571125e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 31, - "lidar_time_i": 1784282910.2059953, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 22301, - "frame_counter_j": 25658, - "rtk_translation_m": 6.867005915953627, - "rtk_rotation_deg": 145.82839665297058, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8291601669444454, - 0.557002572130979, - -0.04734503344738811, - -6.639621714290518 - ], - [ - -0.5563039913889392, - -0.8305050761416612, - -0.028056864893798827, - -6.11595200473075 - ], - [ - -0.05494803651992986, - 0.00307459629994485, - 0.9984844816721975, - -0.21379717440210833 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6497, - "backend_objective": 391.5634240770806, - "backend_elapsed_sec": 0.21663290000287816, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 3763, - "objective": 1185.4290060618462 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5653, - "objective": 684.2903187539537 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6497, - "objective": 391.5634240770806 - } - ], - "heldout_symmetric": { - "evaluated": 7923, - "inliers": 4833, - "inlier_ratio": 0.6099962135554714, - "inlier_rmse_m": 0.12348129729633385, - "median_m": 0.16829967983417726, - "p90_m": 1.4849730718195646, - "p95_m": 2.1820192648045715 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15283.296924362496, - 28883.464673809176, - 37536.78369939378, - 73211.99383013883, - 295122.7325758525, - 662622.7649407667 - ], - "effective_rank": 6, - "scaled_condition_number": 43.35600938855713, - "weakest_scaled_direction": [ - 0.9651752542755169, - 0.16403194369182295, - 0.02893253464986352, - 0.03597486340884722, - 0.0725758486677953, - -0.18474770313720218 - ] - }, - "forward_reverse": { - "translation_m": 0.011230201352754812, - "rotation_deg": 0.02547666380871279 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.771561172376096e-16, - "rotation_deg": 3.3568020374558377e-14 - }, - { - "translation_m": 3.3306690738754696e-16, - "rotation_deg": 1.2877186688978997e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283066.8004546, - "frame_counter_i": 22832, - "frame_counter_j": 23867, - "rtk_translation_m": 5.622863551235285, - "rtk_rotation_deg": 90.80966440028486, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.0050057248075906545, - 0.9997689451549719, - 0.020904521588993533, - 2.74120230244797 - ], - [ - -0.9991080488777081, - -0.0041236999428806076, - -0.04202501358193204, - 2.583961915034938 - ], - [ - -0.04192909952444908, - -0.02109624143052765, - 0.9988978422294112, - -0.004636717439527438 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 7896, - "backend_objective": 1079.9871118552, - "backend_elapsed_sec": 0.12130400000023656, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4259, - "objective": 1023.151397767661 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6470, - "objective": 470.76259236617295 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 7896, - "objective": 1079.9871118552 - } - ], - "heldout_symmetric": { - "evaluated": 7953, - "inliers": 5660, - "inlier_ratio": 0.7116811266188859, - "inlier_rmse_m": 0.11387091842867321, - "median_m": 0.12212561338207634, - "p90_m": 0.767271471014885, - "p95_m": 1.1511383668365165 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 71068.97082250098, - 104379.83985126337, - 187293.56476249878, - 225839.8186466437, - 525286.3459828754, - 768741.867967755 - ], - "effective_rank": 6, - "scaled_condition_number": 10.816842555490693, - "weakest_scaled_direction": [ - -0.14823824065683378, - 0.28331167057110984, - -0.007109975062191335, - -0.9369505318462866, - 0.09256671090313431, - 0.10613422862265139 - ] - }, - "forward_reverse": { - "translation_m": 0.011430300098438593, - "rotation_deg": 0.17858658887118406 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.200468367758596e-16, - "rotation_deg": 1.945028151596618e-15 - }, - { - "translation_m": 4.359707647240379e-15, - "rotation_deg": 3.896970141638708e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 22832, - "frame_counter_j": 24538, - "rtk_translation_m": 2.458639091699311, - "rtk_rotation_deg": 114.59973437015381, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.41844520046973865, - 0.9082396991499938, - 0.0020647255915706097, - 0.2765688904757041 - ], - [ - -0.9073279133309602, - -0.41792099165666197, - -0.04580504800999918, - -2.4770664433716276 - ], - [ - -0.040739070857424606, - -0.021040285659670886, - 0.9989482641683868, - -0.09923903581438462 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8537, - "backend_objective": 1088.412188786713, - "backend_elapsed_sec": 0.1146429000000353, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4382, - "objective": 892.5864128272805 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6916, - "objective": 812.4949883299853 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8537, - "objective": 1088.412188786713 - } - ], - "heldout_symmetric": { - "evaluated": 7928, - "inliers": 6016, - "inlier_ratio": 0.7588294651866802, - "inlier_rmse_m": 0.10898351788466304, - "median_m": 0.10644822213791405, - "p90_m": 0.7433781678711225, - "p95_m": 1.209383313153328 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 69257.0273144771, - 75429.73880547307, - 164344.04971797438, - 274695.7995948595, - 673059.7794943709, - 793166.4014263131 - ], - "effective_rank": 6, - "scaled_condition_number": 11.452504275483305, - "weakest_scaled_direction": [ - -0.8752272884177408, - -0.09781033412722306, - -0.027622592492544704, - -0.4034161419188513, - -0.20638417254509123, - 0.13530821960630407 - ] - }, - "forward_reverse": { - "translation_m": 0.002552411031283606, - "rotation_deg": 0.096053889700167 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0531708436766994e-06, - "rotation_deg": 4.775460694632327e-06 - }, - { - "translation_m": 1.4060466165506383e-15, - "rotation_deg": 5.073305422726997e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 22832, - "frame_counter_j": 25032, - "rtk_translation_m": 2.614522132166758, - "rtk_rotation_deg": 143.98503586800658, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8029897605080275, - 0.595910038253646, - -0.009933319072655914, - -0.9683340247500691 - ], - [ - -0.5951119596316267, - -0.8025974086323753, - -0.0409774957751413, - -3.010648368235239 - ], - [ - -0.03239135722173524, - -0.026993072539724904, - 0.999110691571359, - -0.05728229515931686 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8421, - "backend_objective": 687.6600541358612, - "backend_elapsed_sec": 0.08787040000606794, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4332, - "objective": 876.5178676987696 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7069, - "objective": 661.1233098272667 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8421, - "objective": 687.6600541358612 - } - ], - "heldout_symmetric": { - "evaluated": 7916, - "inliers": 6095, - "inlier_ratio": 0.7699595755432036, - "inlier_rmse_m": 0.10809432324457112, - "median_m": 0.10258491634321046, - "p90_m": 0.6749757479546841, - "p95_m": 1.1575881716166816 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42298.77852782947, - 65573.79111202822, - 128946.20312676755, - 276839.06019393535, - 602220.0140914132, - 819952.8583942328 - ], - "effective_rank": 6, - "scaled_condition_number": 19.384788093934308, - "weakest_scaled_direction": [ - -0.7744985253417116, - -0.6269652784901497, - -0.013502706029628827, - 0.028384954561481334, - -0.0717144194657676, - 0.03058736890273389 - ] - }, - "forward_reverse": { - "translation_m": 0.006419845852952349, - "rotation_deg": 0.09683669503892821 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.619484885243114e-06, - "rotation_deg": 1.4924084946599249e-05 - }, - { - "translation_m": 5.707390442361855e-06, - "rotation_deg": 3.091323752181703e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 31, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 22832, - "frame_counter_j": 25658, - "rtk_translation_m": 6.500901961576647, - "rtk_rotation_deg": 114.69190834512194, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.41886044623131186, - 0.9078185126418123, - -0.020529848701674975, - -2.152132024278162 - ], - [ - -0.9069944552994834, - -0.41935644649260784, - -0.03874569448449772, - -7.688615772852688 - ], - [ - -0.043783383136756095, - 0.0023914200592377076, - 0.9990381856922187, - -0.14393925577034686 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6635, - "backend_objective": 422.1406339343399, - "backend_elapsed_sec": 0.10813280000002123, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3819, - "objective": 1126.036978018063 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5827, - "objective": 697.608480663271 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6635, - "objective": 422.1406339343399 - } - ], - "heldout_symmetric": { - "evaluated": 7934, - "inliers": 5084, - "inlier_ratio": 0.6407864885303756, - "inlier_rmse_m": 0.12195597170279295, - "median_m": 0.1535183081345192, - "p90_m": 1.2602701861788788, - "p95_m": 2.028768905810599 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16218.597900492301, - 29610.813474848466, - 50859.70618426775, - 84189.35604185889, - 268607.54517291614, - 741368.2775907042 - ], - "effective_rank": 6, - "scaled_condition_number": 45.71099685307573, - "weakest_scaled_direction": [ - 0.9706811179224929, - 0.1848719218725011, - 0.022025934469173954, - -0.058158039492227566, - 0.0384714086762028, - -0.13510363125969738 - ] - }, - "forward_reverse": { - "translation_m": 0.03203829198983217, - "rotation_deg": 0.21314212616538905 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4564247694356734e-06, - "rotation_deg": 1.6032002205066762e-05 - }, - { - "translation_m": 1.961830370053296e-15, - "rotation_deg": 1.918033389087075e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 32, - "lidar_time_i": 1784282963.3037353, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 22832, - "frame_counter_j": 26188, - "rtk_translation_m": 8.204840364723921, - "rtk_rotation_deg": 69.85846065460369, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.344991018091877, - 0.9385433795904607, - 0.010840759329771512, - -1.1809981876567281 - ], - [ - -0.9377826210414906, - 0.3451490650255806, - -0.037892988593140754, - -9.422887458853303 - ], - [ - -0.03930589152382708, - 0.0029064650149383774, - 0.9992229978101151, - -0.21261152803012742 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6483, - "backend_objective": 396.93790348862245, - "backend_elapsed_sec": 0.08730060000380035, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3903, - "objective": 1005.6464916035786 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5657, - "objective": 653.9078918872137 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6483, - "objective": 396.93790348862245 - } - ], - "heldout_symmetric": { - "evaluated": 7803, - "inliers": 4776, - "inlier_ratio": 0.6120722798923491, - "inlier_rmse_m": 0.12793570356778294, - "median_m": 0.17308025742591235, - "p90_m": 1.3317057724671162, - "p95_m": 2.100100968958307 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14644.061213091272, - 27538.70115537152, - 39464.85071392285, - 83477.85930772258, - 246229.60888379632, - 741756.9500963197 - ], - "effective_rank": 6, - "scaled_condition_number": 50.652407095458955, - "weakest_scaled_direction": [ - -0.8668239901485068, - 0.48940268117373753, - -0.005101565133149508, - -0.011421772401278516, - -0.06649081656358242, - 0.067258265098737 - ] - }, - "forward_reverse": { - "translation_m": 0.02476270066797521, - "rotation_deg": 0.18953242722457034 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0547118733938987e-15, - "rotation_deg": 6.406938000382308e-14 - }, - { - "translation_m": 3.885780586188048e-16, - "rotation_deg": 2.6003136503658074e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283133.8969557, - "frame_counter_i": 23867, - "frame_counter_j": 24538, - "rtk_translation_m": 5.5254251571777075, - "rtk_rotation_deg": 23.790069969868927, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9102734209654582, - 0.414007039134331, - 0.000686025559389431, - 5.0754652480088 - ], - [ - -0.4139603354973354, - 0.9101932748905069, - -0.013603050357479112, - -2.4460497943959667 - ], - [ - -0.00625617445225439, - 0.012098507813743296, - 0.9999072388926399, - 0.09920510715460941 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 7687, - "backend_objective": 691.3744808466765, - "backend_elapsed_sec": 0.11987450000015087, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4361, - "objective": 1282.907200861367 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6545, - "objective": 705.6021424606338 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 7687, - "objective": 691.3744808466765 - } - ], - "heldout_symmetric": { - "evaluated": 7915, - "inliers": 5344, - "inlier_ratio": 0.6751737207833228, - "inlier_rmse_m": 0.11816626627973714, - "median_m": 0.1387134948339588, - "p90_m": 0.8922948694305884, - "p95_m": 1.2782908510513573 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47706.79458519957, - 65838.24977140462, - 121311.37039411726, - 144831.16109063648, - 457766.56047272356, - 743334.151733743 - ], - "effective_rank": 6, - "scaled_condition_number": 15.58130572797597, - "weakest_scaled_direction": [ - -0.2363015537339811, - 0.1752794248793193, - -0.000674311212016816, - -0.903670361535916, - -0.2979260945745155, - 0.08976727730300661 - ] - }, - "forward_reverse": { - "translation_m": 0.0036062245918322845, - "rotation_deg": 0.04228106700822467 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.385205275550698e-15, - "rotation_deg": 7.643117507755694e-15 - }, - { - "translation_m": 2.3177567589976558e-15, - "rotation_deg": 7.327828549230946e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 23867, - "frame_counter_j": 25032, - "rtk_translation_m": 6.682895390289165, - "rtk_rotation_deg": 53.17537146772172, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5999367768597786, - 0.8000473984167767, - -0.00015510528022255455, - 5.628303348127421 - ], - [ - -0.7994682677268504, - 0.5994951024462893, - -0.0381590230580222, - -3.6819571285907506 - ], - [ - -0.030436042267839462, - 0.023017003051242615, - 0.9992716672164833, - 0.07361738353796984 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7299, - "backend_objective": 559.5933776455493, - "backend_elapsed_sec": 0.09829349999927217, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4158, - "objective": 1005.3280584825617 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6432, - "objective": 664.007289991132 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7299, - "objective": 559.5933776455493 - } - ], - "heldout_symmetric": { - "evaluated": 7903, - "inliers": 5118, - "inlier_ratio": 0.6476021763887132, - "inlier_rmse_m": 0.12162303323930705, - "median_m": 0.15189509389827444, - "p90_m": 1.1688885959554405, - "p95_m": 1.652537357677809 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35362.13597606628, - 41678.157427662954, - 65709.7625339488, - 140643.99422607553, - 408986.802121887, - 691946.9563285194 - ], - "effective_rank": 6, - "scaled_condition_number": 19.56745364015458, - "weakest_scaled_direction": [ - 0.5897020987912308, - 0.7157847563490614, - 0.013298141431142744, - -0.3004566814756481, - -0.20737613921397088, - 0.08029754750525643 - ] - }, - "forward_reverse": { - "translation_m": 0.036760870155111036, - "rotation_deg": 0.061189777619461184 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.621746912567286e-07, - "rotation_deg": 7.416099437788698e-06 - }, - { - "translation_m": 8.621746929083309e-07, - "rotation_deg": 7.416099445261761e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 23867, - "frame_counter_j": 25658, - "rtk_translation_m": 11.27338119162288, - "rtk_rotation_deg": 23.882243944837096, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9103153265395868, - 0.41390312282532643, - 0.0031954941039620288, - 10.309251528424408 - ], - [ - -0.41341808639106337, - 0.9095727240940202, - -0.0419874437056491, - -4.842879639441652 - ], - [ - -0.020285268346187872, - 0.03690073846993658, - 0.9991130283348808, - 0.12510630066467948 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6079, - "backend_objective": 339.1466518673327, - "backend_elapsed_sec": 0.09573049999744399, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3736, - "objective": 1139.7870021970266 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5486, - "objective": 617.2920264829778 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6079, - "objective": 339.1466518673327 - } - ], - "heldout_symmetric": { - "evaluated": 7921, - "inliers": 4424, - "inlier_ratio": 0.558515338972352, - "inlier_rmse_m": 0.1324943729180927, - "median_m": 0.20709442059080946, - "p90_m": 1.6130096076003502, - "p95_m": 2.2550212607908677 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14684.338050456314, - 20996.39388405723, - 41421.213482041596, - 84660.74937247872, - 232526.3089035502, - 686483.6018413204 - ], - "effective_rank": 6, - "scaled_condition_number": 46.74937334475135, - "weakest_scaled_direction": [ - 0.964872268560723, - 0.2546023946915128, - 0.014024865625530944, - -0.03035208803132967, - 0.050157986148948494, - -0.0237772223280574 - ] - }, - "forward_reverse": { - "translation_m": 0.011294835537302048, - "rotation_deg": 0.22869636591571527 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9389211565826713e-15, - "rotation_deg": 1.0478046849755252e-14 - }, - { - "translation_m": 4.061874015289015e-06, - "rotation_deg": 8.390291225107998e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 32, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 23867, - "frame_counter_j": 26188, - "rtk_translation_m": 12.874594603353637, - "rtk_rotation_deg": 20.951203745681177, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9368052957063175, - -0.3498496435855262, - 0.0010319010027924572, - 12.023410387851335 - ], - [ - 0.34984444150089505, - 0.9367649292315812, - -0.008962929915956054, - -3.864814199428018 - ], - [ - 0.0021690291667244028, - 0.008757525040318358, - 0.9999592997055636, - 0.14808885116222767 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 5940, - "backend_objective": 441.9883230677034, - "backend_elapsed_sec": 0.08663430000160588, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3913, - "objective": 1739.3293498747505 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5459, - "objective": 614.846701124823 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 5940, - "objective": 441.9883230677034 - } - ], - "heldout_symmetric": { - "evaluated": 7790, - "inliers": 4173, - "inlier_ratio": 0.5356867779204108, - "inlier_rmse_m": 0.13793317141107478, - "median_m": 0.22180765473389125, - "p90_m": 1.572528691664501, - "p95_m": 2.200974263176926 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14665.209651964393, - 24020.80571948947, - 40980.30064074865, - 64164.99431482809, - 188393.8016565995, - 694584.9334189682 - ], - "effective_rank": 6, - "scaled_condition_number": 47.36276875018484, - "weakest_scaled_direction": [ - -0.8745791381663993, - 0.40640117256825276, - 0.006202221424973696, - -0.01534104905564682, - -0.05083780551231419, - -0.25901953635435915 - ] - }, - "forward_reverse": { - "translation_m": 0.009260784922164039, - "rotation_deg": 0.4736145985672847 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.501116646229826e-12, - "rotation_deg": 1.1201470432970728e-10 - }, - { - "translation_m": 1.907072653828599e-15, - "rotation_deg": 1.4395846952577327e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 33, - "lidar_time_i": 1784283066.8004546, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 23867, - "frame_counter_j": 26803, - "rtk_translation_m": 13.796424177198949, - "rtk_rotation_deg": 59.567633422321585, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5177977838869198, - -0.8552769395288492, - -0.019667529381180906, - 12.784536490864836 - ], - [ - 0.8555003946868746, - 0.5176021394309098, - 0.01439096755420536, - -1.81868673886356 - ], - [ - -0.00212830740160022, - -0.024277190255672067, - 0.9997030000659671, - 0.26166163585124713 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 12, - "backend_num_inliers": 5632, - "backend_objective": 342.9249705224627, - "backend_elapsed_sec": 0.11299599999620114, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3964, - "objective": 1579.3444901700204 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5367, - "objective": 654.139960770697 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 12, - "num_inliers": 5632, - "objective": 342.9249705224627 - } - ], - "heldout_symmetric": { - "evaluated": 7977, - "inliers": 3986, - "inlier_ratio": 0.49968659897204465, - "inlier_rmse_m": 0.13776776698165452, - "median_m": 0.25010093415534185, - "p90_m": 1.630028974714434, - "p95_m": 2.1629435915950883 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 11438.47973460157, - 17583.399385488527, - 32032.06026128799, - 54994.521117229946, - 182480.30305702027, - 682370.4799451078 - ], - "effective_rank": 6, - "scaled_condition_number": 59.65569689133837, - "weakest_scaled_direction": [ - 0.1322875177711942, - -0.799747726751828, - -0.013632124753326468, - 0.019404373296195248, - 0.04483919780893496, - 0.5833786660555577 - ] - }, - "forward_reverse": { - "translation_m": 0.03480709552965627, - "rotation_deg": 0.1328751318540718 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.928762266452001e-15, - "rotation_deg": 9.003524244854555e-15 - }, - { - "translation_m": 4.825320989909783e-15, - "rotation_deg": 1.6595522851322983e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283183.2952216, - "frame_counter_i": 24538, - "frame_counter_j": 25032, - "rtk_translation_m": 1.1998189814142899, - "rtk_rotation_deg": 29.3853014978528, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8773272847218084, - 0.479879543661196, - 0.003529739109635477, - 1.0275725366399584 - ], - [ - -0.4796997306016397, - 0.8771595713073665, - -0.02189189175453565, - -0.8921258941596125 - ], - [ - -0.013601615469281557, - 0.01751313905044429, - 0.9997541127783498, - 0.013222532583380717 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9152, - "backend_objective": 1669.9845827207955, - "backend_elapsed_sec": 0.11383700000442332, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4515, - "objective": 890.8444595135836 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7660, - "objective": 1035.8641350345395 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9152, - "objective": 1669.9845827207955 - } - ], - "heldout_symmetric": { - "evaluated": 7878, - "inliers": 6402, - "inlier_ratio": 0.8126428027418127, - "inlier_rmse_m": 0.11465616151168853, - "median_m": 0.10797022509561946, - "p90_m": 0.42712714089735, - "p95_m": 0.6849025165473656 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 81497.03234668853, - 125353.6969703817, - 236951.4800607994, - 383154.2070222109, - 661803.4862036908, - 793685.502701832 - ], - "effective_rank": 6, - "scaled_condition_number": 9.73882704495904, - "weakest_scaled_direction": [ - -0.10964115359146293, - 0.07463007441200648, - -0.017388411389327285, - -0.6813130443601991, - -0.7167291811452107, - 0.06495097429062456 - ] - }, - "forward_reverse": { - "translation_m": 0.059123063905753705, - "rotation_deg": 0.35885997079417975 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0383697063485126e-06, - "rotation_deg": 2.0998154279827437e-06 - }, - { - "translation_m": 1.0934648863700224e-15, - "rotation_deg": 5.930291471085202e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 24538, - "frame_counter_j": 25658, - "rtk_translation_m": 5.755712819539279, - "rtk_rotation_deg": 0.09217397496817598, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.999941157593839, - 0.00018585098927047247, - 0.010846511388648542, - 5.742627769670279 - ], - [ - 0.0002364363011509317, - 0.9992423508301242, - -0.03891874105572634, - -0.012675533363900718 - ], - [ - -0.010845526624825247, - 0.03891901549239097, - 0.999183509063942, - 0.1275546325181011 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7607, - "backend_objective": 642.1981674287681, - "backend_elapsed_sec": 0.0949458000031882, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4085, - "objective": 1070.5027716657692 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6454, - "objective": 758.4410844048668 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7607, - "objective": 642.1981674287681 - } - ], - "heldout_symmetric": { - "evaluated": 7896, - "inliers": 5668, - "inlier_ratio": 0.7178318135764944, - "inlier_rmse_m": 0.11831514282300001, - "median_m": 0.12800979691455083, - "p90_m": 0.8520213437659627, - "p95_m": 1.425009033651708 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38600.108881835404, - 44643.01877689907, - 143105.2569055979, - 201934.39674350785, - 398331.3472664213, - 755498.453973045 - ], - "effective_rank": 6, - "scaled_condition_number": 19.572443598172608, - "weakest_scaled_direction": [ - 0.11456685513188783, - -0.03810199116569201, - 0.00889137450455551, - 0.9442096432313197, - 0.2965643028473087, - -0.0765596586949824 - ] - }, - "forward_reverse": { - "translation_m": 0.03055388488044922, - "rotation_deg": 0.16788276176822323 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9797899796144628e-16, - "rotation_deg": 3.552455822155075e-15 - }, - { - "translation_m": 9.345906929778292e-08, - "rotation_deg": 5.5451911504416426e-08 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 24538, - "frame_counter_j": 26188, - "rtk_translation_m": 7.3497160995478215, - "rtk_rotation_deg": 44.7412737155501, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7080431259113152, - -0.7061317161919821, - -0.007275385728595915, - 6.9046602839390845 - ], - [ - 0.7060729332119444, - 0.7080791417850065, - -0.00921639595991639, - 1.5890876986785167 - ], - [ - 0.011659538379139685, - 0.0013886528634575843, - 0.999931061027714, - 0.1748431974883761 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7209, - "backend_objective": 678.0748546012143, - "backend_elapsed_sec": 0.08079139999608742, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4284, - "objective": 1012.1372448117104 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6240, - "objective": 648.6073320194935 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7209, - "objective": 678.0748546012143 - } - ], - "heldout_symmetric": { - "evaluated": 7765, - "inliers": 5332, - "inlier_ratio": 0.6866709594333548, - "inlier_rmse_m": 0.12344589693451308, - "median_m": 0.1420110787162983, - "p90_m": 0.8396537728344576, - "p95_m": 1.2540886288715745 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 39108.67795498014, - 49638.42066771643, - 146536.6818614558, - 225655.08057179616, - 362896.75880510744, - 770305.908521257 - ], - "effective_rank": 6, - "scaled_condition_number": 19.69654687402097, - "weakest_scaled_direction": [ - -0.04825106370939505, - 0.09838949485342222, - 0.003690094178337567, - -0.880751030577914, - 0.4569291376701072, - 0.05891613227588333 - ] - }, - "forward_reverse": { - "translation_m": 0.01847461637742171, - "rotation_deg": 0.10764991453418553 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.886119947416683e-16, - "rotation_deg": 1.9005200009037052e-15 - }, - { - "translation_m": 9.964986097963502e-16, - "rotation_deg": 2.4850636286058835e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 33, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 24538, - "frame_counter_j": 26803, - "rtk_translation_m": 8.359102419083325, - "rtk_rotation_deg": 83.35770339219052, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.11727327100016108, - -0.9924174316596471, - -0.03680517962181283, - 6.791542166483658 - ], - [ - 0.9930558621640427, - 0.11683938198936715, - 0.01373366076373441, - 3.775031455631846 - ], - [ - -0.0093292299014099, - -0.038160190702011466, - 0.999228084730925, - 0.21658152867426064 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6817, - "backend_objective": 653.5900838000304, - "backend_elapsed_sec": 0.08357650000107242, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4224, - "objective": 992.0590814097582 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6070, - "objective": 679.2329593754828 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6817, - "objective": 653.5900838000304 - } - ], - "heldout_symmetric": { - "evaluated": 7952, - "inliers": 4892, - "inlier_ratio": 0.6151911468812877, - "inlier_rmse_m": 0.12607024585552623, - "median_m": 0.17059127216500558, - "p90_m": 0.9953851258762062, - "p95_m": 1.5164738320240407 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36742.594714943065, - 51078.787795489865, - 86736.09775198369, - 99296.01806052207, - 370511.35273197334, - 709912.9436864179 - ], - "effective_rank": 6, - "scaled_condition_number": 19.321252328369155, - "weakest_scaled_direction": [ - 0.15591105145097048, - 0.09341463765044133, - 0.024550826752390807, - -0.39440010641545814, - 0.8992231144301225, - 0.04700056327247212 - ] - }, - "forward_reverse": { - "translation_m": 0.005640558537625966, - "rotation_deg": 0.060018922799470055 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.305364597889227e-16, - "rotation_deg": 2.5857095134264785e-15 - }, - { - "translation_m": 2.874277142073027e-15, - "rotation_deg": 1.078883051621802e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 34, - "lidar_time_i": 1784283133.8969557, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 24538, - "frame_counter_j": 27410, - "rtk_translation_m": 8.008340805017072, - "rtk_rotation_deg": 133.40261903862776, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6862586507197509, - -0.7257027478982426, - -0.04903657823754838, - 5.282362483435766 - ], - [ - 0.7268489391236612, - -0.686739347669981, - -0.008926816712487224, - 3.7461762226223545 - ], - [ - -0.027197132332586024, - -0.04176829006255042, - 0.9987570905571255, - 0.17172334915202492 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7174, - "backend_objective": 824.6272624549424, - "backend_elapsed_sec": 0.13687229999777628, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 4389, - "objective": 967.7702960298735 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6363, - "objective": 708.0486024874558 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7174, - "objective": 824.6272624549424 - } - ], - "heldout_symmetric": { - "evaluated": 8013, - "inliers": 5200, - "inlier_ratio": 0.6489454636216149, - "inlier_rmse_m": 0.1229782406905996, - "median_m": 0.15469423976978755, - "p90_m": 0.9075775199083312, - "p95_m": 1.3977558671526833 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36759.40070690087, - 79671.29530560404, - 99395.8500651576, - 143250.60712805425, - 545030.6363158716, - 711706.5470191201 - ], - "effective_rank": 6, - "scaled_condition_number": 19.361211916752247, - "weakest_scaled_direction": [ - 0.14975491367912053, - -0.11015492367256777, - 0.013247029831832074, - 0.4302857189343582, - 0.8803932745171404, - 0.07089257426849613 - ] - }, - "forward_reverse": { - "translation_m": 0.024951598645873194, - "rotation_deg": 0.20519725330906424 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8791740161887652e-07, - "rotation_deg": 6.751435337203136e-07 - }, - { - "translation_m": 1.879173991463769e-07, - "rotation_deg": 6.751435304418562e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283245.892713, - "frame_counter_i": 25032, - "frame_counter_j": 25658, - "rtk_translation_m": 4.592128513798009, - "rtk_rotation_deg": 29.29312752288462, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8774615845539951, - -0.4796197225335111, - 0.005107777292523286, - 3.732534176379011 - ], - [ - 0.47964497955036145, - 0.8774385702264954, - -0.006499928539371522, - 3.0482693132691554 - ], - [ - -0.0013642668820459758, - 0.00815335733066481, - 0.9999658301862681, - 0.08100434241251409 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8022, - "backend_objective": 682.2037989617496, - "backend_elapsed_sec": 0.09509400000388268, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4137, - "objective": 978.522081128475 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6695, - "objective": 862.5292909484554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8022, - "objective": 682.2037989617496 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 6000, - "inlier_ratio": 0.76103500761035, - "inlier_rmse_m": 0.11418966560335815, - "median_m": 0.11409419679059057, - "p90_m": 0.5905110574980494, - "p95_m": 1.0447138247539731 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42934.01908105151, - 44646.61149457188, - 125328.33753210271, - 332646.2999853765, - 373076.539164921, - 719412.5731741893 - ], - "effective_rank": 6, - "scaled_condition_number": 16.756236396505788, - "weakest_scaled_direction": [ - 0.34386703083246445, - 0.1620296178044596, - 0.0002941699220129694, - -0.878345873378501, - -0.24641833408627015, - -0.15260508795505065 - ] - }, - "forward_reverse": { - "translation_m": 0.010805499433410783, - "rotation_deg": 0.0764328342532002 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.92846187333838e-07, - "rotation_deg": 2.4333550860368694e-06 - }, - { - "translation_m": 3.9284618747328264e-07, - "rotation_deg": 2.433355086259841e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 25032, - "frame_counter_j": 26188, - "rtk_translation_m": 6.2188831730504885, - "rtk_rotation_deg": 74.12657521340287, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2823969446931978, - -0.9590301672310669, - -0.022651798354619786, - 3.9755458845171816 - ], - [ - 0.9592910049684202, - 0.2822284174615593, - 0.01038692273111732, - 5.006051817393974 - ], - [ - -0.0035683910415569182, - -0.02466290165197707, - 0.999689455714863, - 0.13404787229728973 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7342, - "backend_objective": 487.57135665731505, - "backend_elapsed_sec": 0.09921169999870472, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4241, - "objective": 1100.7105586118391 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6327, - "objective": 661.2252423873856 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7342, - "objective": 487.57135665731505 - } - ], - "heldout_symmetric": { - "evaluated": 7753, - "inliers": 5467, - "inlier_ratio": 0.7051463949438926, - "inlier_rmse_m": 0.11749249261595905, - "median_m": 0.13098520099369815, - "p90_m": 0.7513026638122486, - "p95_m": 1.1212007867363225 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 37985.62473170701, - 44213.61372689415, - 104801.69420644897, - 224286.64425725662, - 337381.0463026317, - 780774.2687053755 - ], - "effective_rank": 6, - "scaled_condition_number": 20.554466965332146, - "weakest_scaled_direction": [ - 0.7044484945599631, - -0.4619780857842014, - -0.004303544844761858, - 0.1866099881394012, - -0.029928861634439682, - -0.5045701356967279 - ] - }, - "forward_reverse": { - "translation_m": 0.009422682577629085, - "rotation_deg": 0.037900377279079585 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2755491433176288e-15, - "rotation_deg": 6.085454041329009e-15 - }, - { - "translation_m": 1.0767589454103068e-15, - "rotation_deg": 5.728657435425742e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 25032, - "frame_counter_j": 26803, - "rtk_translation_m": 7.344850966128434, - "rtk_rotation_deg": 112.7430048900433, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.37343657305038874, - -0.9262562170076977, - -0.050936689752771165, - 2.8193864929364123 - ], - [ - 0.9270865256976757, - -0.37456761745947525, - 0.01448011811228747, - 6.869364164215804 - ], - [ - -0.03249153394648, - -0.04181531304821952, - 0.9985969055712539, - 0.12268657129687172 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6622, - "backend_objective": 564.2483177080967, - "backend_elapsed_sec": 0.11038040000130422, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4146, - "objective": 1058.8682734761378 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5826, - "objective": 598.3433489921683 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6622, - "objective": 564.2483177080967 - } - ], - "heldout_symmetric": { - "evaluated": 7940, - "inliers": 4815, - "inlier_ratio": 0.6064231738035264, - "inlier_rmse_m": 0.12368925274094972, - "median_m": 0.16956895841990516, - "p90_m": 1.0285014819689906, - "p95_m": 1.396165723408926 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31247.70599813066, - 45620.48258912383, - 57291.98785925098, - 90396.7108457152, - 355387.10381595045, - 634051.6741001282 - ], - "effective_rank": 6, - "scaled_condition_number": 20.291143104650924, - "weakest_scaled_direction": [ - -0.1612342482588208, - -0.13331371233444483, - -0.013180598965349838, - 0.39984953591402794, - -0.8902190937560807, - -0.06072525705483543 - ] - }, - "forward_reverse": { - "translation_m": 0.0147669225762263, - "rotation_deg": 0.09037435316445036 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2900535501789785e-14, - "rotation_deg": 6.835967542612091e-14 - }, - { - "translation_m": 1.2588308695936154e-15, - "rotation_deg": 2.7390601371168487e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 34, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 25032, - "frame_counter_j": 27410, - "rtk_translation_m": 7.0347870411064095, - "rtk_rotation_deg": 162.78792053648075, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9503307022274861, - -0.30660880919323424, - -0.05350321979956074, - 1.527922014329157 - ], - [ - 0.30763790373238953, - -0.9514279462175943, - -0.011990969239905757, - 6.13889607748841 - ], - [ - -0.04722792173020439, - -0.027855004600217927, - 0.9984956795739112, - 0.06559236815603574 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6955, - "backend_objective": 817.7290414475714, - "backend_elapsed_sec": 0.15054290000261972, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 4350, - "objective": 1265.4554139503887 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6180, - "objective": 829.5921418372718 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6955, - "objective": 817.7290414475714 - } - ], - "heldout_symmetric": { - "evaluated": 8001, - "inliers": 5143, - "inlier_ratio": 0.6427946506686664, - "inlier_rmse_m": 0.12352381867411776, - "median_m": 0.15717724716534115, - "p90_m": 0.9308450208720612, - "p95_m": 1.3333693212296118 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31002.095247374673, - 68250.99095719183, - 84098.96363556453, - 99215.33779536579, - 545909.8291591693, - 665775.224512567 - ], - "effective_rank": 6, - "scaled_condition_number": 21.47516866844496, - "weakest_scaled_direction": [ - 0.13220584184838674, - -0.0590702940264384, - 0.0053650531476843585, - 0.43108680481086376, - 0.8891593739774166, - 0.050629105616832516 - ] - }, - "forward_reverse": { - "translation_m": 3.1821548176867474, - "rotation_deg": 2.4099911828321603 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0115134153574873e-15, - "rotation_deg": 1.511175015194238e-14 - }, - { - "translation_m": 9.408280408450705e-16, - "rotation_deg": 5.4285676355284266e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 30, - "j": 35, - "lidar_time_i": 1784283183.2952216, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 25032, - "frame_counter_j": 28031, - "rtk_translation_m": 9.281470813161304, - "rtk_rotation_deg": 166.02816439171798, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9716040807410224, - 0.23182160697342968, - -0.047373545652080816, - 4.436385357657898 - ], - [ - -0.2305477922825371, - -0.9725715442135184, - -0.03085946953174121, - 5.785088772778676 - ], - [ - -0.05322805426690966, - -0.01906132016385976, - 0.9984004408615658, - 0.14236662643033315 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7206, - "backend_objective": 583.2754059607055, - "backend_elapsed_sec": 0.16594110000005458, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 4051, - "objective": 2390.3243237159404 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 6193, - "objective": 676.406060075604 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7206, - "objective": 583.2754059607055 - } - ], - "heldout_symmetric": { - "evaluated": 7726, - "inliers": 5337, - "inlier_ratio": 0.690784364483562, - "inlier_rmse_m": 0.12252550482763978, - "median_m": 0.13978604816675527, - "p90_m": 0.8010550526095055, - "p95_m": 1.2995635583969385 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 39719.1465222697, - 44517.795224211666, - 85912.81299502063, - 146359.04223228933, - 307965.27354962897, - 660711.6091529367 - ], - "effective_rank": 6, - "scaled_condition_number": 16.634587270964886, - "weakest_scaled_direction": [ - 0.21022769224122723, - 0.041227263691367824, - 0.01034046819579436, - 0.808103007926082, - 0.5326112428500406, - 0.13150094080079971 - ] - }, - "forward_reverse": { - "translation_m": 0.009824737708452339, - "rotation_deg": 0.14818916841264132 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.818360945611186e-15, - "rotation_deg": 1.2669497184496225e-14 - }, - { - "translation_m": 8.920730087951354e-16, - "rotation_deg": 3.033557463376703e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283298.8906527, - "frame_counter_i": 25658, - "frame_counter_j": 26188, - "rtk_translation_m": 1.7043840283934533, - "rtk_rotation_deg": 44.83344769051828, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7079766041187452, - -0.7061288154379645, - -0.012297317946032733, - 1.1561409094177428 - ], - [ - 0.7062101707269308, - 0.7076948992948283, - 0.020859632641107052, - 1.607770363252775 - ], - [ - -0.006026838501921915, - -0.02345262288656664, - 0.9997067828605609, - 0.037495010753049944 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8528, - "backend_objective": 1155.051755854621, - "backend_elapsed_sec": 0.09654559999762569, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4455, - "objective": 1141.0439271995288 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7037, - "objective": 936.42583499589 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8528, - "objective": 1155.051755854621 - } - ], - "heldout_symmetric": { - "evaluated": 7771, - "inliers": 6185, - "inlier_ratio": 0.7959078625659504, - "inlier_rmse_m": 0.10965414855273443, - "median_m": 0.10095515085678866, - "p90_m": 0.48442074388805095, - "p95_m": 0.7645498361756877 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 69311.66109871498, - 107104.28949745452, - 238629.53001555963, - 510060.0285515343, - 617708.4261233442, - 892877.5288894214 - ], - "effective_rank": 6, - "scaled_condition_number": 12.882067962817517, - "weakest_scaled_direction": [ - -0.04923843952393764, - 0.06169864530501276, - 0.002069945837136591, - -0.8824484952020298, - 0.4595516259017, - 0.06214117002264006 - ] - }, - "forward_reverse": { - "translation_m": 0.009608345699366565, - "rotation_deg": 0.04073745185785107 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.362595086444728e-07, - "rotation_deg": 9.196885157802857e-08 - }, - { - "translation_m": 2.055892507939274e-15, - "rotation_deg": 1.0431768410614332e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 25658, - "frame_counter_j": 26803, - "rtk_translation_m": 3.3472002644811774, - "rtk_rotation_deg": 83.44987736715868, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.11761195592589196, - -0.9924670579491105, - -0.0343011181905573, - 1.0376768166365944 - ], - [ - 0.9923750646719047, - 0.11617843889313238, - 0.041161892009323714, - 3.794403539306469 - ], - [ - -0.036866771498444736, - -0.038880705011499844, - 0.998563534251622, - 0.021383721224311047 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7129, - "backend_objective": 914.7396766005143, - "backend_elapsed_sec": 0.11347879999811994, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4123, - "objective": 1164.1362153457158 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5965, - "objective": 501.03357907069915 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7129, - "objective": 914.7396766005143 - } - ], - "heldout_symmetric": { - "evaluated": 7958, - "inliers": 5062, - "inlier_ratio": 0.636089469716009, - "inlier_rmse_m": 0.11810494837446742, - "median_m": 0.15047429891211012, - "p90_m": 1.1072909924746916, - "p95_m": 1.5485323900479468 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53697.87483738007, - 55122.61889411014, - 98952.45230533827, - 152798.4389974455, - 417221.71094772464, - 735727.6187405491 - ], - "effective_rank": 6, - "scaled_condition_number": 13.701242758091343, - "weakest_scaled_direction": [ - 0.7117648542912769, - -0.4617542292156325, - 0.008282821139063737, - 0.2380425460820263, - -0.3625813220502915, - -0.30327504022952917 - ] - }, - "forward_reverse": { - "translation_m": 0.01055590691460776, - "rotation_deg": 0.06271370554561609 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.4796043696850615e-16, - "rotation_deg": 5.208815676633617e-15 - }, - { - "translation_m": 8.899114524108741e-16, - "rotation_deg": 2.3302841051932675e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 34, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 25658, - "frame_counter_j": 27410, - "rtk_translation_m": 3.311630046755356, - "rtk_rotation_deg": 133.49479301359594, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.685744660822533, - -0.726047167068268, - -0.051085921206648885, - -0.48478440011271323 - ], - [ - 0.725552341170661, - -0.6874645358320884, - 0.03108556248395467, - 3.7490992691755816 - ], - [ - -0.05768934368808241, - -0.015748751230306862, - 0.9982103568184029, - -0.0832414852883311 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7239, - "backend_objective": 803.0541538700068, - "backend_elapsed_sec": 0.13346390000515385, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 4242, - "objective": 1137.4933874522956 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6063, - "objective": 647.1854794450308 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7239, - "objective": 803.0541538700068 - } - ], - "heldout_symmetric": { - "evaluated": 8019, - "inliers": 5292, - "inlier_ratio": 0.6599326599326599, - "inlier_rmse_m": 0.11513164519765848, - "median_m": 0.14044748704241777, - "p90_m": 1.113244018978122, - "p95_m": 1.4807093723824782 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 48893.3323882685, - 65056.52883212168, - 98663.07875035396, - 143345.44266778225, - 419899.00907723326, - 743163.5184167791 - ], - "effective_rank": 6, - "scaled_condition_number": 15.199690471396346, - "weakest_scaled_direction": [ - -0.1368563343040179, - 0.16450367025894858, - 0.004800144307778075, - -0.43388777541254886, - -0.8743518854891829, - -0.037894901185876115 - ] - }, - "forward_reverse": { - "translation_m": 0.002580333972310516, - "rotation_deg": 0.03476275200242535 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.9663350254149825e-06, - "rotation_deg": 3.471838429947821e-05 - }, - { - "translation_m": 8.969201507613714e-08, - "rotation_deg": 1.515642872482503e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 35, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 25658, - "frame_counter_j": 28031, - "rtk_translation_m": 4.805055361756335, - "rtk_rotation_deg": 164.67870808539848, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9631071016403969, - -0.2633751650548271, - -0.05530129476040849, - 1.9117439699026628 - ], - [ - 0.2638294780649017, - -0.9645688690948707, - -0.0009504088829123195, - 2.062163988236093 - ], - [ - -0.05309159325012265, - -0.015505457277546819, - 0.998469260178188, - 0.08747780844153522 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8239, - "backend_objective": 1168.074823968981, - "backend_elapsed_sec": 0.09365809999871999, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 4181, - "objective": 922.1516546262212 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6830, - "objective": 653.1583162078713 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8239, - "objective": 1168.074823968981 - } - ], - "heldout_symmetric": { - "evaluated": 7744, - "inliers": 6000, - "inlier_ratio": 0.7747933884297521, - "inlier_rmse_m": 0.1099315236542533, - "median_m": 0.10601762321926043, - "p90_m": 0.6071825609600104, - "p95_m": 1.0734202932729884 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 61064.5055200236, - 77211.93160059862, - 172561.45333495192, - 264728.68874414585, - 478398.39742677164, - 853871.5051581641 - ], - "effective_rank": 6, - "scaled_condition_number": 13.983106845566315, - "weakest_scaled_direction": [ - -0.03445536924415684, - 0.08383817286312215, - -0.000425115133935425, - -0.8382058798592384, - -0.5374448387477581, - -0.018648213081714573 - ] - }, - "forward_reverse": { - "translation_m": 0.002969158365974405, - "rotation_deg": 0.02482993261597952 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.634754316485563e-16, - "rotation_deg": 4.936654922521141e-15 - }, - { - "translation_m": 1.3877787807814457e-16, - "rotation_deg": 4.924920769750705e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 36, - "lidar_time_i": 1784283245.892713, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 25658, - "frame_counter_j": 28788, - "rtk_translation_m": 5.921091773191984, - "rtk_rotation_deg": 169.88970913698103, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9830061741635658, - 0.17694469720444117, - -0.04888185437907935, - 3.1142645337538695 - ], - [ - -0.1760367303058353, - -0.9841303340177249, - -0.022328350798744366, - 1.4160554403025953 - ], - [ - -0.05205699894864749, - -0.013343904877876586, - 0.9985549604619017, - 0.07726998178478338 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8155, - "backend_objective": 890.3677640273263, - "backend_elapsed_sec": 0.10692599999310914, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3917, - "objective": 684.5028441154692 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6579, - "objective": 620.0670891462463 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8155, - "objective": 890.3677640273263 - } - ], - "heldout_symmetric": { - "evaluated": 7754, - "inliers": 6151, - "inlier_ratio": 0.79326799071447, - "inlier_rmse_m": 0.11165900641583826, - "median_m": 0.10626901115399692, - "p90_m": 0.5406794490632864, - "p95_m": 1.1117513844978757 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 60134.47729083502, - 70954.17982117122, - 243470.0402365618, - 328318.1119913637, - 375799.5113082092, - 732548.8489687224 - ], - "effective_rank": 6, - "scaled_condition_number": 12.181844458808802, - "weakest_scaled_direction": [ - -0.12884738882450322, - 0.029170782739809692, - 0.0020839536195904787, - -0.9760013104248249, - -0.1352946673597839, - -0.10798086866568495 - ] - }, - "forward_reverse": { - "translation_m": 0.004151989866605975, - "rotation_deg": 0.032942374858786365 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.942634605520997e-08, - "rotation_deg": 1.5843573788789117e-06 - }, - { - "translation_m": 8.942634647591839e-08, - "rotation_deg": 1.584357371928524e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283360.3892086, - "frame_counter_i": 26188, - "frame_counter_j": 26803, - "rtk_translation_m": 1.9394369188755196, - "rtk_rotation_deg": 38.61642967664041, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7842092810633423, - -0.6204877137209277, - -0.0032864289878168536, - 1.4559940638863316 - ], - [ - 0.6203171111627641, - 0.7838443506414765, - 0.028190699993512792, - 1.6328024912881645 - ], - [ - -0.014915934191282693, - -0.024146036710349157, - 0.999597160769469, - 0.02563053125540825 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8518, - "backend_objective": 1533.5718421970232, - "backend_elapsed_sec": 0.10003339999821037, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4500, - "objective": 853.0136282655557 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6889, - "objective": 689.1214999481404 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8518, - "objective": 1533.5718421970232 - } - ], - "heldout_symmetric": { - "evaluated": 7827, - "inliers": 5854, - "inlier_ratio": 0.7479238533282229, - "inlier_rmse_m": 0.1140254726045761, - "median_m": 0.11694244736623101, - "p90_m": 0.5910289929156334, - "p95_m": 0.8275727488834601 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 69877.78860543235, - 163401.12938928476, - 242803.52783533448, - 357604.94618078147, - 565959.3064836741, - 898777.4489029327 - ], - "effective_rank": 6, - "scaled_condition_number": 12.862133545437658, - "weakest_scaled_direction": [ - 0.08842727918412378, - 0.05381282612169527, - 0.007479436440605393, - -0.4087499202178809, - 0.9055066207008073, - 0.04701187786402185 - ] - }, - "forward_reverse": { - "translation_m": 0.005854383016193307, - "rotation_deg": 0.042356141718508426 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.1206070861174796e-12, - "rotation_deg": 3.4621284797627695e-11 - }, - { - "translation_m": 4.120854947818124e-12, - "rotation_deg": 3.462211576893644e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 26188, - "frame_counter_j": 27410, - "rtk_translation_m": 2.1435446082722334, - "rtk_rotation_deg": 88.6613453230776, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0273633108959293, - -0.9992990553769012, - -0.025546959499013252, - 0.3581567107204911 - ], - [ - 0.999305165642153, - 0.02669860938826939, - 0.02600711782650782, - 2.6768961546616024 - ], - [ - -0.025306819984382965, - -0.02624084944440861, - 0.9993352704086419, - -0.008525602494821816 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8356, - "backend_objective": 1233.111841503875, - "backend_elapsed_sec": 0.13058799999998882, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4515, - "objective": 913.9124198936138 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6884, - "objective": 899.6867968144992 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8356, - "objective": 1233.111841503875 - } - ], - "heldout_symmetric": { - "evaluated": 7888, - "inliers": 5858, - "inlier_ratio": 0.7426470588235294, - "inlier_rmse_m": 0.11481351455228676, - "median_m": 0.11739528615465933, - "p90_m": 0.6722695875318564, - "p95_m": 1.08901469495805 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 56881.18119066128, - 136125.61494251975, - 184142.1518334489, - 320828.91833767673, - 509397.9806823492, - 857625.2473892898 - ], - "effective_rank": 6, - "scaled_condition_number": 15.077486603426832, - "weakest_scaled_direction": [ - -0.09695761816404562, - 0.0169207829285552, - -0.0023335116731640648, - -0.42969524573468726, - -0.8947905795192173, - -0.0708468538820254 - ] - }, - "forward_reverse": { - "translation_m": 0.0025843844761028077, - "rotation_deg": 0.009064526838353553 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3358046614212626e-15, - "rotation_deg": 1.148227768019422e-14 - }, - { - "translation_m": 1.4047618905949049e-15, - "rotation_deg": 2.3130808417733572e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 35, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 26188, - "frame_counter_j": 28031, - "rtk_translation_m": 3.1027737257249126, - "rtk_rotation_deg": 119.84526039487966, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.49509181862611884, - -0.8673771052903346, - -0.05040881220224653, - 0.8663587035389528 - ], - [ - 0.868460694710409, - -0.49575736655145053, - 0.0008094770436961302, - -0.21060946122736388 - ], - [ - -0.02569266184333249, - -0.04337730660298996, - 0.9987283396396018, - 0.02190326902049819 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 9073, - "backend_objective": 1244.802026177927, - "backend_elapsed_sec": 0.13181400000030408, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 4383, - "objective": 854.5975043183511 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 7352, - "objective": 746.1589292265447 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 9073, - "objective": 1244.802026177927 - } - ], - "heldout_symmetric": { - "evaluated": 7613, - "inliers": 6250, - "inlier_ratio": 0.8209641402863523, - "inlier_rmse_m": 0.10635864973089924, - "median_m": 0.09472610366645577, - "p90_m": 0.44438863958438385, - "p95_m": 0.7779500609335901 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 92637.72216711899, - 160304.46462182794, - 266916.44140749756, - 392486.21266712435, - 659823.8378731592, - 1011048.9027001207 - ], - "effective_rank": 6, - "scaled_condition_number": 10.914008667831691, - "weakest_scaled_direction": [ - 0.10539847716857471, - -0.04320914668614716, - -0.010442788341845534, - 0.8294929926967327, - 0.5409157042445745, - 0.07916220558740023 - ] - }, - "forward_reverse": { - "translation_m": 0.004447738370013908, - "rotation_deg": 0.11616784364821804 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4337214048435802e-15, - "rotation_deg": 1.8996664115072616e-14 - }, - { - "translation_m": 8.099505462106327e-16, - "rotation_deg": 7.714963123860832e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 36, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 26188, - "frame_counter_j": 28788, - "rtk_translation_m": 4.235311686227635, - "rtk_rotation_deg": 145.27684317250132, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8197333897152037, - -0.569358802759699, - -0.06219102432075246, - 1.24764430964592 - ], - [ - 0.5715655178110531, - -0.8201738570831699, - -0.025054001810063037, - -1.5078012340092455 - ], - [ - -0.036742735818188, - -0.05608384684878452, - 0.9977497549422089, - 0.0684749652733764 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8022, - "backend_objective": 711.4716146185955, - "backend_elapsed_sec": 0.11844220000057248, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 29, - "num_inliers": 3978, - "objective": 785.8233759899201 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6633, - "objective": 862.8024228873745 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8022, - "objective": 711.4716146185955 - } - ], - "heldout_symmetric": { - "evaluated": 7623, - "inliers": 5804, - "inlier_ratio": 0.7613800341073068, - "inlier_rmse_m": 0.10898930843612145, - "median_m": 0.10858673882389068, - "p90_m": 0.6346716884786665, - "p95_m": 1.272822442958009 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 65302.52836780936, - 77054.44857594876, - 192401.23695948906, - 247900.29010261796, - 513376.33891936264, - 798444.8792278486 - ], - "effective_rank": 6, - "scaled_condition_number": 12.22686011069426, - "weakest_scaled_direction": [ - -0.5005979376075405, - -0.015096733966080744, - -0.004277658808426327, - -0.7127961536295928, - -0.12293848424203545, - -0.47535593778229174 - ] - }, - "forward_reverse": { - "translation_m": 0.008302372052489307, - "rotation_deg": 0.047221847858387886 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.772800161809615e-16, - "rotation_deg": 3.977197288053644e-15 - }, - { - "translation_m": 7.696856831808123e-16, - "rotation_deg": 1.6901970531227868e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 37, - "lidar_time_i": 1784283298.8906527, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 26188, - "frame_counter_j": 29564, - "rtk_translation_m": 3.1931475050378357, - "rtk_rotation_deg": 118.78221388859481, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.48224497898845536, - -0.8751899817780894, - -0.03850033812439116, - -3.767058051549315 - ], - [ - 0.8752841844984565, - -0.4831862055619484, - 0.02021601151361305, - 3.7478891752455734 - ], - [ - -0.036295683039401214, - -0.023949667010509868, - 0.9990540710305869, - -0.08072331680775709 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7855, - "backend_objective": 553.6170568281559, - "backend_elapsed_sec": 0.104597500001546, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 4286, - "objective": 1443.5526590970578 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6519, - "objective": 728.1639864411554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7855, - "objective": 553.6170568281559 - } - ], - "heldout_symmetric": { - "evaluated": 7805, - "inliers": 5401, - "inlier_ratio": 0.6919923126201153, - "inlier_rmse_m": 0.11497666348297753, - "median_m": 0.12944890777489212, - "p90_m": 1.061421420073525, - "p95_m": 1.7138343946937833 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 45138.50340943636, - 47217.18669752816, - 81084.28289484356, - 119501.66785245285, - 525369.1447799009, - 763674.1579704946 - ], - "effective_rank": 6, - "scaled_condition_number": 16.91846428853567, - "weakest_scaled_direction": [ - 0.6574222312127012, - 0.4605909559749285, - 0.024429024982743103, - 0.3814764373915629, - 0.33395030909331547, - 0.3130624900739918 - ] - }, - "forward_reverse": { - "translation_m": 0.00567166990415677, - "rotation_deg": 0.10190182649448634 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2887833992611187e-16, - "rotation_deg": 3.8307451321561157e-14 - }, - { - "translation_m": 1.159106867033638e-15, - "rotation_deg": 9.792794535212416e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 34, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283421.0858324, - "frame_counter_i": 26803, - "frame_counter_j": 27410, - "rtk_translation_m": 0.5704890065278277, - "rtk_rotation_deg": 50.0449156464372, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6417320301105107, - -0.7666374208950454, - -0.021143945082131462, - -0.21461888032798607 - ], - [ - 0.766927852643647, - 0.6415336479388286, - 0.01600772943623858, - 1.503956865861741 - ], - [ - 0.0012924278109744153, - -0.02648855310683145, - 0.9996482812392865, - 0.00879047872790855 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9514, - "backend_objective": 1345.2671068438228, - "backend_elapsed_sec": 0.08930059999693185, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4711, - "objective": 807.751088203844 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7514, - "objective": 663.7658058441194 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9514, - "objective": 1345.2671068438228 - } - ], - "heldout_symmetric": { - "evaluated": 8075, - "inliers": 6660, - "inlier_ratio": 0.8247678018575851, - "inlier_rmse_m": 0.10774292174748101, - "median_m": 0.09948778695103232, - "p90_m": 0.4188826624780101, - "p95_m": 0.6472695244209828 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 71149.4097725868, - 219826.22118453225, - 381397.08782854903, - 456282.1335059236, - 803850.1477718899, - 946813.6166070981 - ], - "effective_rank": 6, - "scaled_condition_number": 13.307399451848953, - "weakest_scaled_direction": [ - 0.08456772948098389, - -0.03226685879428026, - 0.004705237279868437, - 0.4313780733187884, - 0.8965312276428206, - 0.043928640055757216 - ] - }, - "forward_reverse": { - "translation_m": 0.005218203824516851, - "rotation_deg": 0.054034410494683056 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5319877213864657e-15, - "rotation_deg": 2.2912308442276127e-14 - }, - { - "translation_m": 3.4915808093142e-16, - "rotation_deg": 8.210893411165915e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 26803, - "frame_counter_j": 28031, - "rtk_translation_m": 2.3843314966611664, - "rtk_rotation_deg": 81.22883071823928, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.15024285037045615, - -0.987535124178277, - -0.04691976584292301, - -1.6090724261666272 - ], - [ - 0.9886485900609374, - 0.15012269671681636, - 0.006094366332217427, - -1.0804860994847696 - ], - [ - 0.0010253209649869319, - -0.04730279531554929, - 0.9988800700145407, - -0.034804570982266754 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8023, - "backend_objective": 938.5023427736984, - "backend_elapsed_sec": 0.08114949999435339, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4186, - "objective": 972.8804876548338 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6675, - "objective": 661.4068390036327 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8023, - "objective": 938.5023427736984 - } - ], - "heldout_symmetric": { - "evaluated": 7800, - "inliers": 5536, - "inlier_ratio": 0.7097435897435898, - "inlier_rmse_m": 0.11216257584808116, - "median_m": 0.12131908005883268, - "p90_m": 0.8572241403697525, - "p95_m": 1.166798868262447 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 64980.90739087001, - 127739.74091812782, - 170655.31465281927, - 202066.40723695478, - 501890.8456145986, - 839567.5651930566 - ], - "effective_rank": 6, - "scaled_condition_number": 12.920219167499932, - "weakest_scaled_direction": [ - 0.09828196660419128, - -0.07405861908960484, - -0.00764901959033891, - 0.8300978770251836, - 0.5398184455297131, - 0.06581055312354249 - ] - }, - "forward_reverse": { - "translation_m": 0.0055472051152683725, - "rotation_deg": 0.06161504272529624 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8732571918778673e-15, - "rotation_deg": 1.1304568969979162e-14 - }, - { - "translation_m": 6.753223014464259e-16, - "rotation_deg": 1.1302760454722714e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 26803, - "frame_counter_j": 28788, - "rtk_translation_m": 3.5605240220038255, - "rtk_rotation_deg": 106.66041349586102, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.28798013085725144, - -0.9545836261914464, - -0.07640382738206802, - -2.110876036235906 - ], - [ - 0.9573473298874358, - -0.28893559453606044, - 0.0015205813003238086, - -2.3327391649330336 - ], - [ - -0.02352730730105037, - -0.072707102935557, - 0.9970757960124597, - -0.13053696746353466 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6636, - "backend_objective": 483.2858538791529, - "backend_elapsed_sec": 0.09562529999675462, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3755, - "objective": 1078.8740349872571 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5492, - "objective": 493.6826206248057 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6636, - "objective": 483.2858538791529 - } - ], - "heldout_symmetric": { - "evaluated": 7810, - "inliers": 4858, - "inlier_ratio": 0.62202304737516, - "inlier_rmse_m": 0.11282494351568334, - "median_m": 0.14981296996885993, - "p90_m": 1.3324479381658763, - "p95_m": 1.9779957157427326 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38236.06679495578, - 54335.64364952997, - 72843.1056675724, - 95276.2791436862, - 358244.64875116, - 707031.9341187379 - ], - "effective_rank": 6, - "scaled_condition_number": 18.491230751066993, - "weakest_scaled_direction": [ - 0.6337186485717154, - 0.4313555219184962, - 0.010657754096631476, - 0.16215477025129688, - 0.06897928063999015, - 0.6173873903535895 - ] - }, - "forward_reverse": { - "translation_m": 0.009207361872581905, - "rotation_deg": 0.07430583689659953 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.847302891456678e-16, - "rotation_deg": 1.4641870457497906e-14 - }, - { - "translation_m": 5.978733960281817e-16, - "rotation_deg": 4.3537125312492905e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 37, - "lidar_time_i": 1784283360.3892086, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 26803, - "frame_counter_j": 29564, - "rtk_translation_m": 4.013080941901569, - "rtk_rotation_deg": 80.16578421195443, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1656155269446003, - -0.9856992565372883, - -0.03112029718205315, - -2.7829396927203383 - ], - [ - 0.986093754343881, - 0.1650750633420992, - 0.019217989140308995, - 4.898675599171988 - ], - [ - -0.013805972579191906, - -0.03387032808283578, - 0.9993308741336413, - -0.027013542532653992 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7512, - "backend_objective": 689.4851053586125, - "backend_elapsed_sec": 0.2124005000005127, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 4335, - "objective": 1592.1029357270409 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6323, - "objective": 675.2869070546722 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7512, - "objective": 689.4851053586125 - } - ], - "heldout_symmetric": { - "evaluated": 7992, - "inliers": 5058, - "inlier_ratio": 0.6328828828828829, - "inlier_rmse_m": 0.12540757119118434, - "median_m": 0.1657283082571933, - "p90_m": 1.1675133045894066, - "p95_m": 1.7326284980689792 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42809.32379199054, - 56384.91415524119, - 91345.31402366323, - 97945.35394210857, - 521479.87494787603, - 728537.0829643705 - ], - "effective_rank": 6, - "scaled_condition_number": 17.018187124475837, - "weakest_scaled_direction": [ - -0.05407514470105457, - 0.10232579745601551, - -0.003493943250303685, - -0.8253064822041906, - -0.5420907243321728, - -0.10770310713195938 - ] - }, - "forward_reverse": { - "translation_m": 0.0036940550280262596, - "rotation_deg": 0.12927083795080543 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.721958498152797e-16, - "rotation_deg": 9.239552042171033e-16 - }, - { - "translation_m": 6.087272963323595e-16, - "rotation_deg": 2.0545887207732876e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 35, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283483.1839027, - "frame_counter_i": 27410, - "frame_counter_j": 28031, - "rtk_translation_m": 2.9403442697824866, - "rtk_rotation_deg": 31.183915071802076, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8546927210108861, - -0.5185183931852261, - -0.025279014609337618, - -2.8729928456518645 - ], - [ - 0.5190290532818415, - 0.8544860206356053, - 0.02150540368567032, - -0.5932763342421689 - ], - [ - 0.01044961723522882, - -0.03150105501312544, - 0.999449092766959, - -0.117953715679509 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8038, - "backend_objective": 1067.3971057079461, - "backend_elapsed_sec": 0.09174789999815403, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4232, - "objective": 931.7738320185995 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6778, - "objective": 635.9128104832854 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8038, - "objective": 1067.3971057079461 - } - ], - "heldout_symmetric": { - "evaluated": 7861, - "inliers": 5618, - "inlier_ratio": 0.7146673451214858, - "inlier_rmse_m": 0.11428688542425412, - "median_m": 0.12488637095215238, - "p90_m": 0.7542043225384906, - "p95_m": 1.1645586606251188 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 60913.63905996634, - 108616.79140980766, - 184812.5191752562, - 250394.25562252666, - 445407.56801270787, - 834822.4446111553 - ], - "effective_rank": 6, - "scaled_condition_number": 13.705016766266674, - "weakest_scaled_direction": [ - -0.11331493649980072, - 0.030545809313574757, - -0.005871512491549641, - -0.827900440697021, - -0.5451726471333641, - -0.05966447143623407 - ] - }, - "forward_reverse": { - "translation_m": 0.013436446539858737, - "rotation_deg": 0.05510481554154184 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.2914688736145975e-16, - "rotation_deg": 2.0710670697400905e-14 - }, - { - "translation_m": 6.6973807122470445e-16, - "rotation_deg": 2.2710478315935853e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 36, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 27410, - "frame_counter_j": 28788, - "rtk_translation_m": 4.102710388907318, - "rtk_rotation_deg": 56.61549784942384, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5493384359693135, - -0.8345153004488866, - -0.04256167388029166, - -4.16405703333326 - ], - [ - 0.8355850334941111, - 0.5483111845350708, - 0.0339484420024438, - -1.0122797958609087 - ], - [ - -0.004993452456342919, - -0.054213081728046356, - 0.9985169038139087, - -0.17027367608351823 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 6713, - "backend_objective": 476.2669339373927, - "backend_elapsed_sec": 0.10732570000254782, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3761, - "objective": 1093.5064618593124 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5686, - "objective": 533.4032942478066 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 6713, - "objective": 476.2669339373927 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 5089, - "inlier_ratio": 0.6465506288908652, - "inlier_rmse_m": 0.11729490897001751, - "median_m": 0.14677969706017155, - "p90_m": 1.2514209854958938, - "p95_m": 1.724581141736587 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35042.55983786695, - 49869.52208855948, - 66711.1071840269, - 115853.61830866558, - 333428.1836141259, - 692242.4573280298 - ], - "effective_rank": 6, - "scaled_condition_number": 19.754334744118587, - "weakest_scaled_direction": [ - 0.7508204918989283, - 0.26937809262675844, - 0.010994298846574895, - 0.23052054458148646, - 0.08652969489023742, - 0.5504144329306327 - ] - }, - "forward_reverse": { - "translation_m": 0.086056763787067, - "rotation_deg": 1.0836879727751445 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.866350197783356e-16, - "rotation_deg": 8.05187903311777e-15 - }, - { - "translation_m": 5.828670879282072e-16, - "rotation_deg": 1.1482919492982322e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 34, - "j": 37, - "lidar_time_i": 1784283421.0858324, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 27410, - "frame_counter_j": 29564, - "rtk_translation_m": 3.6865711881345757, - "rtk_rotation_deg": 30.12086856551724, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8626785698110787, - -0.505705541081148, - -0.006898616421885131, - 0.9620670621720004 - ], - [ - 0.505743861030865, - 0.8625032661149866, - 0.017642646359710818, - 4.153479840567233 - ], - [ - -0.002971904827890494, - -0.018708865834253074, - 0.9998205569605427, - 0.058506638200363954 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8218, - "backend_objective": 1068.690716507707, - "backend_elapsed_sec": 0.089938400000392, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4509, - "objective": 971.6761969093786 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6821, - "objective": 667.6927029322333 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8218, - "objective": 1068.690716507707 - } - ], - "heldout_symmetric": { - "evaluated": 8053, - "inliers": 5556, - "inlier_ratio": 0.6899292189246243, - "inlier_rmse_m": 0.11937420197560855, - "median_m": 0.1402371743473001, - "p90_m": 0.8957892077081874, - "p95_m": 1.3640513262009966 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51650.64075235593, - 81611.94381125418, - 212125.73042549557, - 251535.97918387392, - 659915.3258462228, - 868173.7933021421 - ], - "effective_rank": 6, - "scaled_condition_number": 16.808577408839643, - "weakest_scaled_direction": [ - 0.022461108950379973, - 0.09760103533057535, - -0.0016157224052011654, - -0.8281056846951625, - -0.5432132109370136, - -0.0955369476552555 - ] - }, - "forward_reverse": { - "translation_m": 0.005083360744530967, - "rotation_deg": 0.10024940937419655 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2247786310271853e-15, - "rotation_deg": 2.6623626721193576e-14 - }, - { - "translation_m": 1.2609709600486848e-15, - "rotation_deg": 4.595651837322293e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 36, - "lidar_time_i": 1784283483.1839027, - "lidar_time_j": 1784283558.880709, - "frame_counter_i": 28031, - "frame_counter_j": 28788, - "rtk_translation_m": 1.2045561534352058, - "rtk_rotation_deg": 25.431582777621774, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9032195997715037, - -0.4289938418735286, - -0.012595166660085857, - -1.3137260398549253 - ], - [ - 0.42916827718262096, - 0.9030131492973146, - 0.019540779315238267, - 0.3151871751627638 - ], - [ - 0.002990727120001826, - -0.023055060848669824, - 0.9997297233355412, - -0.024553303306160124 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 8703, - "backend_objective": 1085.3729002480788, - "backend_elapsed_sec": 0.09698239999852376, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4123, - "objective": 810.0674126589012 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6980, - "objective": 813.5615775357485 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 8703, - "objective": 1085.3729002480788 - } - ], - "heldout_symmetric": { - "evaluated": 7596, - "inliers": 6261, - "inlier_ratio": 0.8242496050552922, - "inlier_rmse_m": 0.10907898456971946, - "median_m": 0.09854508617547358, - "p90_m": 0.4112497567541792, - "p95_m": 0.6555833730516762 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 83738.17090681267, - 105485.73878651983, - 268592.3843328227, - 274645.4267945677, - 503519.4854165563, - 808915.9677823819 - ], - "effective_rank": 6, - "scaled_condition_number": 9.660062538057792, - "weakest_scaled_direction": [ - -0.3411746897631115, - -0.06416066623896582, - -0.018539382817937624, - -0.8784753819024407, - -0.13832440619848, - -0.2971311045628603 - ] - }, - "forward_reverse": { - "translation_m": 0.0026096461304541156, - "rotation_deg": 0.07595057929078583 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.860647992286328e-16, - "rotation_deg": 4.518587176851247e-15 - }, - { - "translation_m": 4.541813357664188e-16, - "rotation_deg": 1.1339971702481732e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "lidar_time_i": 1784283483.1839027, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 28031, - "frame_counter_j": 29564, - "rtk_translation_m": 6.084062615492111, - "rtk_rotation_deg": 1.063046506284832, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9998774858529235, - 0.014750976549075564, - 0.0052365995918950475, - 5.741711183544315 - ], - [ - -0.01471249771138938, - 0.9998650289285977, - -0.00731206788177003, - 2.0542288961584916 - ], - [ - -0.005343752944286856, - 0.007234128590498913, - 0.9999595550261055, - 0.17112441660270292 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7776, - "backend_objective": 737.2608101741255, - "backend_elapsed_sec": 0.10571569999592612, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4369, - "objective": 1294.035954079842 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6552, - "objective": 829.4306353008226 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7776, - "objective": 737.2608101741255 - } - ], - "heldout_symmetric": { - "evaluated": 7778, - "inliers": 5386, - "inlier_ratio": 0.6924659295448702, - "inlier_rmse_m": 0.12103303062396852, - "median_m": 0.14004857117818825, - "p90_m": 0.8070392588399934, - "p95_m": 1.364817026922233 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47587.01517243663, - 55588.948690171404, - 84315.1045160953, - 198657.56990900284, - 469871.520129114, - 683464.1693404686 - ], - "effective_rank": 6, - "scaled_condition_number": 14.36240888115935, - "weakest_scaled_direction": [ - 0.11420595076319973, - 0.1332063805275653, - 0.014478883709867574, - 0.8049762560360152, - 0.5471174877468391, - 0.14723825842274227 - ] - }, - "forward_reverse": { - "translation_m": 0.005914867863779407, - "rotation_deg": 0.06573359298031699 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.485749680535094e-16, - "rotation_deg": 1.6699472830681995e-15 - }, - { - "translation_m": 2.3929427303327026e-15, - "rotation_deg": 2.0301050393703003e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 36, - "j": 37, - "lidar_time_i": 1784283558.880709, - "lidar_time_j": 1784283636.4777331, - "frame_counter_i": 28788, - "frame_counter_j": 29564, - "rtk_translation_m": 7.2781244258509386, - "rtk_rotation_deg": 26.494629283906598, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.896967584484528, - 0.44205676760033785, - 0.005913256525196426, - 7.123891991003602 - ], - [ - -0.44107206042291147, - 0.895719376157426, - -0.05605565707793089, - -1.4440102552749041 - ], - [ - -0.0300764010193909, - 0.04767193508650709, - 0.9984101345172879, - 0.10025270685855611 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7140, - "backend_objective": 547.5959115678768, - "backend_elapsed_sec": 0.07864669999980833, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4163, - "objective": 1599.706557228684 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6159, - "objective": 639.3994579382346 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7140, - "objective": 547.5959115678768 - } - ], - "heldout_symmetric": { - "evaluated": 7788, - "inliers": 4986, - "inlier_ratio": 0.6402157164869029, - "inlier_rmse_m": 0.12413886977390769, - "median_m": 0.15934980571700327, - "p90_m": 1.1756167084540492, - "p95_m": 1.7182373270123923 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31970.627654605425, - 44442.2161118952, - 51595.05148822733, - 119957.40703155434, - 427869.776626821, - 642144.4375172488 - ], - "effective_rank": 6, - "scaled_condition_number": 20.08544982146282, - "weakest_scaled_direction": [ - 0.5952856724643771, - 0.5428830915821967, - 0.014546708850620054, - 0.1814606260226602, - 0.2092925302950072, - 0.5234214251065616 - ] - }, - "forward_reverse": { - "translation_m": 0.008397869289519334, - "rotation_deg": 0.08479281990151419 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.306248190244746e-14, - "rotation_deg": 3.2572686238697925e-13 - }, - { - "translation_m": 5.251483186427607e-13, - "rotation_deg": 2.6887204546990844e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - } - ] -} diff --git a/results/01_previous_two_batches/small_gicp/B_batch2_refined.npz b/results/01_previous_two_batches/small_gicp/B_batch2_refined.npz deleted file mode 100644 index 74d7a01..0000000 Binary files a/results/01_previous_two_batches/small_gicp/B_batch2_refined.npz and /dev/null differ diff --git a/results/01_previous_two_batches/small_gicp/B_batch2_refined.refinement.json b/results/01_previous_two_batches/small_gicp/B_batch2_refined.refinement.json deleted file mode 100644 index d1121f5..0000000 --- a/results/01_previous_two_batches/small_gicp/B_batch2_refined.refinement.json +++ /dev/null @@ -1,1865 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 154, - "accepted_pairs": 80, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.8131655372700871, - "heldout_inlier_rmse_m": 0.09008834340898543, - "rotation_invariant_error_deg": 0.09042246273947718, - "reverse_translation_m": 0.0005504552049968047, - "reverse_rotation_deg": 0.0032916777115618487, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.8167658604533367, - "heldout_inlier_rmse_m": 0.09980570916927256, - "rotation_invariant_error_deg": 0.3391711294858908, - "reverse_translation_m": 0.00205395151868756, - "reverse_rotation_deg": 0.012799633971915293, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.81441508497705, - "heldout_inlier_rmse_m": 0.10115686777955255, - "rotation_invariant_error_deg": 0.385215875424592, - "reverse_translation_m": 0.01247476852224996, - "reverse_rotation_deg": 0.1726729736128094, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 4, - "heldout_inlier_ratio": 0.7761963190184049, - "heldout_inlier_rmse_m": 0.10269905695661055, - "rotation_invariant_error_deg": 0.19017561281235373, - "reverse_translation_m": 0.019300920937430674, - "reverse_rotation_deg": 0.12217052794626229, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 5, - "heldout_inlier_ratio": 0.7735100978813034, - "heldout_inlier_rmse_m": 0.10986502690369805, - "rotation_invariant_error_deg": 0.04837912933821542, - "reverse_translation_m": 0.0278108340699398, - "reverse_rotation_deg": 0.2717481445912482, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "heldout_inlier_ratio": 0.7850287907869482, - "heldout_inlier_rmse_m": 0.08649388452503427, - "rotation_invariant_error_deg": 0.3477510433363342, - "reverse_translation_m": 0.001960394451155616, - "reverse_rotation_deg": 0.002128143929965857, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.7901992730918661, - "heldout_inlier_rmse_m": 0.09109387779670658, - "rotation_invariant_error_deg": 0.37217653794955297, - "reverse_translation_m": 0.004906057223105903, - "reverse_rotation_deg": 0.018773640398341965, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 5, - "heldout_inlier_ratio": 0.7313806483915384, - "heldout_inlier_rmse_m": 0.10148815288043825, - "rotation_invariant_error_deg": 0.0005135043975172948, - "reverse_translation_m": 0.016729134900242502, - "reverse_rotation_deg": 0.06734086907642674, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 6, - "heldout_inlier_ratio": 0.6214689265536724, - "heldout_inlier_rmse_m": 0.10742176387842234, - "rotation_invariant_error_deg": 0.13623645574216425, - "reverse_translation_m": 0.0027238824581310127, - "reverse_rotation_deg": 0.04004688680398286, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.9176300578034682, - "heldout_inlier_rmse_m": 0.07082931569628453, - "rotation_invariant_error_deg": 0.030869168656224133, - "reverse_translation_m": 0.0016419682635548487, - "reverse_rotation_deg": 0.0015051284247814798, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.840540189585768, - "heldout_inlier_rmse_m": 0.08212714345330237, - "rotation_invariant_error_deg": 0.5569101439660216, - "reverse_translation_m": 0.0015059170263523442, - "reverse_rotation_deg": 0.004861145455894842, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.8300970873786407, - "heldout_inlier_rmse_m": 0.0931389934573794, - "rotation_invariant_error_deg": 0.4656484450266376, - "reverse_translation_m": 0.002555949510569182, - "reverse_rotation_deg": 0.008486377461290648, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 6, - "heldout_inlier_ratio": 0.6495130297446696, - "heldout_inlier_rmse_m": 0.10354826871538153, - "rotation_invariant_error_deg": 0.49017859907297634, - "reverse_translation_m": 0.008359384079660144, - "reverse_rotation_deg": 0.07441619593698878, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 2, - "j": 7, - "heldout_inlier_ratio": 0.8143257302921169, - "heldout_inlier_rmse_m": 0.09968516416989152, - "rotation_invariant_error_deg": 0.7879058854046264, - "reverse_translation_m": 0.013121403719342412, - "reverse_rotation_deg": 0.05039604031914888, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.8855689764780674, - "heldout_inlier_rmse_m": 0.07250679559229746, - "rotation_invariant_error_deg": 0.5867322420314558, - "reverse_translation_m": 0.0006574625393083392, - "reverse_rotation_deg": 0.0008548453445728261, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.8759311584895967, - "heldout_inlier_rmse_m": 0.08543306637795112, - "rotation_invariant_error_deg": 0.49711554735231545, - "reverse_translation_m": 0.0011073394938326227, - "reverse_rotation_deg": 0.004974962253885575, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.678819891780469, - "heldout_inlier_rmse_m": 0.10239967326707564, - "rotation_invariant_error_deg": 0.5114640407614104, - "reverse_translation_m": 0.002691305620040523, - "reverse_rotation_deg": 0.027681404773136364, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 3, - "j": 7, - "heldout_inlier_ratio": 0.7961101683853283, - "heldout_inlier_rmse_m": 0.10180989325686585, - "rotation_invariant_error_deg": 0.8655792360587782, - "reverse_translation_m": 0.023292005056525338, - "reverse_rotation_deg": 0.174639961337377, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.8685714285714285, - "heldout_inlier_rmse_m": 0.07604325543622346, - "rotation_invariant_error_deg": 0.09379994353532695, - "reverse_translation_m": 0.003904582263467037, - "reverse_rotation_deg": 0.011742002375313174, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6822060883963826, - "heldout_inlier_rmse_m": 0.10567824422734254, - "rotation_invariant_error_deg": 0.045443313703408705, - "reverse_translation_m": 0.011923922180697284, - "reverse_rotation_deg": 0.08008579261790838, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.7963870967741935, - "heldout_inlier_rmse_m": 0.10178391918503964, - "rotation_invariant_error_deg": 0.35312743202288743, - "reverse_translation_m": 0.034377900701078094, - "reverse_rotation_deg": 0.11532260919614924, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.6864384971693258, - "heldout_inlier_rmse_m": 0.10315026388508003, - "rotation_invariant_error_deg": 0.1416479753728339, - "reverse_translation_m": 0.002552272421554712, - "reverse_rotation_deg": 0.013899678900349944, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.8104549602398644, - "heldout_inlier_rmse_m": 0.09862238510016193, - "rotation_invariant_error_deg": 0.44788527195135686, - "reverse_translation_m": 0.0037398303757535147, - "reverse_rotation_deg": 0.02129636862756259, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.7806082661814401, - "heldout_inlier_rmse_m": 0.10305777405801758, - "rotation_invariant_error_deg": 0.10050114260539544, - "reverse_translation_m": 0.0056799616182010805, - "reverse_rotation_deg": 0.026182015145595202, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 9, - "heldout_inlier_ratio": 0.7946777980693973, - "heldout_inlier_rmse_m": 0.10313535699942489, - "rotation_invariant_error_deg": 0.12378027898019184, - "reverse_translation_m": 0.06270036555847405, - "reverse_rotation_deg": 0.33857191756776234, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 5, - "j": 10, - "heldout_inlier_ratio": 0.7847418443359877, - "heldout_inlier_rmse_m": 0.10018431236036145, - "rotation_invariant_error_deg": 0.08318270299585606, - "reverse_translation_m": 0.005291671170548772, - "reverse_rotation_deg": 0.044796841001461946, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.7380672159016608, - "heldout_inlier_rmse_m": 0.1046107504689679, - "rotation_invariant_error_deg": 0.29704944087027485, - "reverse_translation_m": 0.010178220865611676, - "reverse_rotation_deg": 0.026255002379027764, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.7026075619295958, - "heldout_inlier_rmse_m": 0.10337241424878332, - "rotation_invariant_error_deg": 0.23699139946137393, - "reverse_translation_m": 0.017447450845101884, - "reverse_rotation_deg": 0.1292664848366822, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 10, - "heldout_inlier_ratio": 0.6619427982478743, - "heldout_inlier_rmse_m": 0.10510077922086615, - "rotation_invariant_error_deg": 0.0031169393568859505, - "reverse_translation_m": 0.003562383894956786, - "reverse_rotation_deg": 0.04536548719264196, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 11, - "heldout_inlier_ratio": 0.638006230529595, - "heldout_inlier_rmse_m": 0.1061575017783152, - "rotation_invariant_error_deg": 0.3229999099449401, - "reverse_translation_m": 0.0059304520508679575, - "reverse_rotation_deg": 0.05963953472442965, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.8040692297529396, - "heldout_inlier_rmse_m": 0.09680052952350976, - "rotation_invariant_error_deg": 0.47450521828696424, - "reverse_translation_m": 0.008328073875015064, - "reverse_rotation_deg": 0.06350723756646647, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "heldout_inlier_ratio": 0.8274764620076913, - "heldout_inlier_rmse_m": 0.09296346258223728, - "rotation_invariant_error_deg": 0.47526402993239714, - "reverse_translation_m": 0.0076981468910999155, - "reverse_rotation_deg": 0.020277033650542, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 11, - "heldout_inlier_ratio": 0.7502523977788995, - "heldout_inlier_rmse_m": 0.1028589368143411, - "rotation_invariant_error_deg": 0.6295801213382788, - "reverse_translation_m": 0.005620519728387707, - "reverse_rotation_deg": 0.0303880139721275, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 12, - "heldout_inlier_ratio": 0.7054418372441338, - "heldout_inlier_rmse_m": 0.10706084863640537, - "rotation_invariant_error_deg": 0.4167576616383002, - "reverse_translation_m": 0.004629206980441498, - "reverse_rotation_deg": 0.07009059694702204, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "heldout_inlier_ratio": 0.8539132734003173, - "heldout_inlier_rmse_m": 0.09158655960119419, - "rotation_invariant_error_deg": 0.012362238826760574, - "reverse_translation_m": 0.0036696927581956673, - "reverse_rotation_deg": 0.014909075167693285, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.7989328474752733, - "heldout_inlier_rmse_m": 0.09757506446655329, - "rotation_invariant_error_deg": 0.182244766293028, - "reverse_translation_m": 0.008689580645481346, - "reverse_rotation_deg": 0.052297435035790506, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "heldout_inlier_ratio": 0.6854158802063672, - "heldout_inlier_rmse_m": 0.10755838259974337, - "rotation_invariant_error_deg": 0.1634677389989463, - "reverse_translation_m": 0.00234148729464824, - "reverse_rotation_deg": 0.061662020462905004, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 12, - "heldout_inlier_ratio": 0.6485376477909147, - "heldout_inlier_rmse_m": 0.11031208403019, - "rotation_invariant_error_deg": 0.05819984889519958, - "reverse_translation_m": 0.013830104055554564, - "reverse_rotation_deg": 0.11563630256710061, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 13, - "heldout_inlier_ratio": 0.622879241516966, - "heldout_inlier_rmse_m": 0.1149201207874094, - "rotation_invariant_error_deg": 0.061859231324277175, - "reverse_translation_m": 0.005835943764379069, - "reverse_rotation_deg": 0.23887217550290574, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.8486154649947754, - "heldout_inlier_rmse_m": 0.09691837979566219, - "rotation_invariant_error_deg": 0.19612011776041882, - "reverse_translation_m": 0.007052114296262031, - "reverse_rotation_deg": 0.2907164943632002, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.6963000378835712, - "heldout_inlier_rmse_m": 0.10535088240045436, - "rotation_invariant_error_deg": 0.13407897326198537, - "reverse_translation_m": 0.0034527207661208545, - "reverse_rotation_deg": 0.020238883727394828, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.6584238791057825, - "heldout_inlier_rmse_m": 0.10587631557960675, - "rotation_invariant_error_deg": 0.08354391500290603, - "reverse_translation_m": 0.009482405807021465, - "reverse_rotation_deg": 0.07225186033919398, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 13, - "heldout_inlier_ratio": 0.621557336004006, - "heldout_inlier_rmse_m": 0.11335203160746431, - "rotation_invariant_error_deg": 0.01986621710150871, - "reverse_translation_m": 0.009011781776631502, - "reverse_rotation_deg": 0.0416830306778097, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.7156362731683045, - "heldout_inlier_rmse_m": 0.10422606491110974, - "rotation_invariant_error_deg": 0.29284075865702874, - "reverse_translation_m": 0.004301999273657816, - "reverse_rotation_deg": 0.02361974788713562, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.692875599852344, - "heldout_inlier_rmse_m": 0.10691573133186853, - "rotation_invariant_error_deg": 0.09564501866487518, - "reverse_translation_m": 0.004231594662123499, - "reverse_rotation_deg": 0.01872424915403812, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.6594721262950173, - "heldout_inlier_rmse_m": 0.10871022234744057, - "rotation_invariant_error_deg": 0.12767268117713115, - "reverse_translation_m": 0.006980776690426113, - "reverse_rotation_deg": 0.21408921607631748, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.8688915375446961, - "heldout_inlier_rmse_m": 0.08660981428891965, - "rotation_invariant_error_deg": 0.22071844131639295, - "reverse_translation_m": 0.005089530929434581, - "reverse_rotation_deg": 0.03170796903435614, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.8021741727392188, - "heldout_inlier_rmse_m": 0.10650327571539893, - "rotation_invariant_error_deg": 0.1366889487428935, - "reverse_translation_m": 0.04485533499047456, - "reverse_rotation_deg": 0.27313934813876123, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.7455741626794259, - "heldout_inlier_rmse_m": 0.11063741423489376, - "rotation_invariant_error_deg": 0.6757601437554115, - "reverse_translation_m": 0.007044503253911164, - "reverse_rotation_deg": 0.40985193451245056, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 16, - "heldout_inlier_ratio": 0.78639603721155, - "heldout_inlier_rmse_m": 0.10318237166131629, - "rotation_invariant_error_deg": 0.038163790310363765, - "reverse_translation_m": 0.008767229441137649, - "reverse_rotation_deg": 0.032548654712657686, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.8217283366828231, - "heldout_inlier_rmse_m": 0.10684146627686454, - "rotation_invariant_error_deg": 0.08721172660861498, - "reverse_translation_m": 0.01763325318199382, - "reverse_rotation_deg": 0.09467538550034012, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.7611268939393939, - "heldout_inlier_rmse_m": 0.10826784336909262, - "rotation_invariant_error_deg": 0.4694217397008771, - "reverse_translation_m": 0.0015931090432955832, - "reverse_rotation_deg": 0.024585439481643892, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "heldout_inlier_ratio": 0.7324469325868906, - "heldout_inlier_rmse_m": 0.11113399174419211, - "rotation_invariant_error_deg": 0.28489100575504267, - "reverse_translation_m": 0.0024416100752998565, - "reverse_rotation_deg": 0.009279978214820864, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 16, - "heldout_inlier_ratio": 0.7500298864315601, - "heldout_inlier_rmse_m": 0.10525785108693746, - "rotation_invariant_error_deg": 0.23678953054522367, - "reverse_translation_m": 0.0024719134275639418, - "reverse_rotation_deg": 0.013160987022490347, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 17, - "heldout_inlier_ratio": 0.6198434030618207, - "heldout_inlier_rmse_m": 0.1221546776649581, - "rotation_invariant_error_deg": 0.03410505009223641, - "reverse_translation_m": 0.013538123192296372, - "reverse_rotation_deg": 0.06236055877935909, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.8278562107011508, - "heldout_inlier_rmse_m": 0.10919246415865995, - "rotation_invariant_error_deg": 0.5598079017994024, - "reverse_translation_m": 0.0049872211162087675, - "reverse_rotation_deg": 0.02566897887278044, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.7886616014026885, - "heldout_inlier_rmse_m": 0.10800229196760061, - "rotation_invariant_error_deg": 0.22744397996170562, - "reverse_translation_m": 0.0038816141140735755, - "reverse_rotation_deg": 0.020030260506224723, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "heldout_inlier_ratio": 0.7477833692786964, - "heldout_inlier_rmse_m": 0.10901310110319071, - "rotation_invariant_error_deg": 0.24060682888978135, - "reverse_translation_m": 0.0024107551433002806, - "reverse_rotation_deg": 0.01470679715840447, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 18, - "heldout_inlier_ratio": 0.6756988719960765, - "heldout_inlier_rmse_m": 0.1140499722068077, - "rotation_invariant_error_deg": 0.18912205154464345, - "reverse_translation_m": 0.010188526275029454, - "reverse_rotation_deg": 0.05757819838859875, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 14, - "j": 15, - "heldout_inlier_ratio": 0.7415730337078652, - "heldout_inlier_rmse_m": 0.11426627617931512, - "rotation_invariant_error_deg": 0.6684920447533642, - "reverse_translation_m": 0.009280638111078932, - "reverse_rotation_deg": 0.07287904157175247, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.7130173965206958, - "heldout_inlier_rmse_m": 0.11194096137848975, - "rotation_invariant_error_deg": 0.7278375341195229, - "reverse_translation_m": 0.0004016408999195087, - "reverse_rotation_deg": 0.020284570842973915, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.6118212736015011, - "heldout_inlier_rmse_m": 0.11991020962112661, - "rotation_invariant_error_deg": 0.2549797723483618, - "reverse_translation_m": 0.020151321868834806, - "reverse_rotation_deg": 0.2079666531947748, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 14, - "j": 18, - "heldout_inlier_ratio": 0.6756292203806016, - "heldout_inlier_rmse_m": 0.1138218459710723, - "rotation_invariant_error_deg": 0.2674862239899909, - "reverse_translation_m": 0.023698120255922432, - "reverse_rotation_deg": 0.1321697884270417, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.7714218177520388, - "heldout_inlier_rmse_m": 0.10015132538295435, - "rotation_invariant_error_deg": 0.019547423157515453, - "reverse_translation_m": 0.007439481433750378, - "reverse_rotation_deg": 0.036349268136368934, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.5587657459840518, - "heldout_inlier_rmse_m": 0.12832496127520593, - "rotation_invariant_error_deg": 0.24894331358842692, - "reverse_translation_m": 0.005430301274456062, - "reverse_rotation_deg": 0.06530638270069017, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 18, - "heldout_inlier_ratio": 0.615040502962157, - "heldout_inlier_rmse_m": 0.11840729454457544, - "rotation_invariant_error_deg": 0.8985437039405042, - "reverse_translation_m": 0.012871328625232324, - "reverse_rotation_deg": 0.037753566213482644, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 19, - "heldout_inlier_ratio": 0.6234350309955026, - "heldout_inlier_rmse_m": 0.11735435665832353, - "rotation_invariant_error_deg": 0.09030622593895998, - "reverse_translation_m": 0.007833445352022574, - "reverse_rotation_deg": 0.016491686030251827, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.5900047370914259, - "heldout_inlier_rmse_m": 0.1265936504427481, - "rotation_invariant_error_deg": 0.11223076939199217, - "reverse_translation_m": 0.011296955150750666, - "reverse_rotation_deg": 0.21501790849158783, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 18, - "heldout_inlier_ratio": 0.6471098982882659, - "heldout_inlier_rmse_m": 0.12019779875781794, - "rotation_invariant_error_deg": 4.661131935848047, - "reverse_translation_m": 0.016821400599454826, - "reverse_rotation_deg": 0.06522344447557246, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 16, - "j": 21, - "heldout_inlier_ratio": 0.49424730531670097, - "heldout_inlier_rmse_m": 0.13389808634231865, - "rotation_invariant_error_deg": 0.1873642533983002, - "reverse_translation_m": 0.04478742358365585, - "reverse_rotation_deg": 0.10475809279093058, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.7629028349890962, - "heldout_inlier_rmse_m": 0.10358638519274684, - "rotation_invariant_error_deg": 0.09605834619720355, - "reverse_translation_m": 0.007136146106563684, - "reverse_rotation_deg": 0.13887814859043496, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.6728380024360536, - "heldout_inlier_rmse_m": 0.10727518915463004, - "rotation_invariant_error_deg": 0.6196793080644909, - "reverse_translation_m": 0.0017207670327870018, - "reverse_rotation_deg": 0.035486867252565536, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 20, - "heldout_inlier_ratio": 0.6354846507130771, - "heldout_inlier_rmse_m": 0.11168219002675635, - "rotation_invariant_error_deg": 0.5758444090655246, - "reverse_translation_m": 0.020290214498459216, - "reverse_rotation_deg": 0.2831192364677464, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 21, - "heldout_inlier_ratio": 0.5695348561959995, - "heldout_inlier_rmse_m": 0.1231813524465837, - "rotation_invariant_error_deg": 0.07092169741204657, - "reverse_translation_m": 0.009859208985419086, - "reverse_rotation_deg": 0.31053558178227947, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.7562595809913132, - "heldout_inlier_rmse_m": 0.11139160446923307, - "rotation_invariant_error_deg": 0.6900607842495887, - "reverse_translation_m": 0.013156152321531143, - "reverse_rotation_deg": 0.09121207325672914, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "heldout_inlier_ratio": 0.6668778509883426, - "heldout_inlier_rmse_m": 0.1149564835181103, - "rotation_invariant_error_deg": 0.48970788585342007, - "reverse_translation_m": 0.0076759006397633354, - "reverse_rotation_deg": 0.11713903044228172, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 21, - "heldout_inlier_ratio": 0.5977438948803768, - "heldout_inlier_rmse_m": 0.12625086545570646, - "rotation_invariant_error_deg": 0.16428921653351836, - "reverse_translation_m": 0.021119392446408227, - "reverse_rotation_deg": 0.18202979634982344, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 20, - "heldout_inlier_ratio": 0.7409531090723751, - "heldout_inlier_rmse_m": 0.11651827109675585, - "rotation_invariant_error_deg": 1.1862646579825622, - "reverse_translation_m": 0.0051743650857167135, - "reverse_rotation_deg": 0.07263138471648796, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 19, - "j": 21, - "heldout_inlier_ratio": 0.6563629565000623, - "heldout_inlier_rmse_m": 0.12291187901196955, - "rotation_invariant_error_deg": 0.5604982157195764, - "reverse_translation_m": 0.0075358808329252175, - "reverse_rotation_deg": 0.06620678153945667, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 22, - "heldout_inlier_ratio": 0.5891492613346918, - "heldout_inlier_rmse_m": 0.12519472268444526, - "rotation_invariant_error_deg": 0.6776179018179675, - "reverse_translation_m": 0.010212573357042046, - "reverse_rotation_deg": 0.11056129275235052, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 23, - "heldout_inlier_ratio": 0.4984627209838586, - "heldout_inlier_rmse_m": 0.13443006540917718, - "rotation_invariant_error_deg": 0.8490548375631022, - "reverse_translation_m": 0.02229275506707497, - "reverse_rotation_deg": 0.2903847316754494, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.7808828984790405, - "heldout_inlier_rmse_m": 0.11119787612354914, - "rotation_invariant_error_deg": 0.6347664796352674, - "reverse_translation_m": 0.0031476308503252674, - "reverse_rotation_deg": 0.022487168529706673, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.6557604850934815, - "heldout_inlier_rmse_m": 0.11898674179731801, - "rotation_invariant_error_deg": 0.5010890735455149, - "reverse_translation_m": 0.008500396323601164, - "reverse_rotation_deg": 0.06463449106814506, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.5833545108005083, - "heldout_inlier_rmse_m": 0.12863144503040289, - "rotation_invariant_error_deg": 0.33147933293170695, - "reverse_translation_m": 0.013890482176493085, - "reverse_rotation_deg": 0.14514813799569015, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 24, - "heldout_inlier_ratio": 0.6348521385962685, - "heldout_inlier_rmse_m": 0.11831053318180502, - "rotation_invariant_error_deg": 0.6083532367573525, - "reverse_translation_m": 0.00725649124030166, - "reverse_rotation_deg": 0.27346756317921195, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 25, - "heldout_inlier_ratio": 0.7094296865164296, - "heldout_inlier_rmse_m": 0.11461231093244224, - "rotation_invariant_error_deg": 0.7123622823574749, - "reverse_translation_m": 0.005999722474434507, - "reverse_rotation_deg": 0.07369423294061743, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7387220368310469, - "heldout_inlier_rmse_m": 0.11520069835112393, - "rotation_invariant_error_deg": 0.1311727752311853, - "reverse_translation_m": 0.0021484382611444506, - "reverse_rotation_deg": 0.09312757978022868, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.6238657551274084, - "heldout_inlier_rmse_m": 0.11987801174807478, - "rotation_invariant_error_deg": 0.3327496051567209, - "reverse_translation_m": 0.007927242611182222, - "reverse_rotation_deg": 0.08795608522524892, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.6712192699279861, - "heldout_inlier_rmse_m": 0.11172772070549726, - "rotation_invariant_error_deg": 0.016706845998086806, - "reverse_translation_m": 0.04673963175312233, - "reverse_rotation_deg": 0.22273623714194987, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 25, - "heldout_inlier_ratio": 0.699310174919931, - "heldout_inlier_rmse_m": 0.11234398811200015, - "rotation_invariant_error_deg": 0.06786466874459052, - "reverse_translation_m": 0.018678960705618183, - "reverse_rotation_deg": 0.1734016933410122, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 26, - "heldout_inlier_ratio": 0.7166481550043194, - "heldout_inlier_rmse_m": 0.11091971646336789, - "rotation_invariant_error_deg": 0.03210854328216328, - "reverse_translation_m": 0.00977162867106615, - "reverse_rotation_deg": 0.0631934229127065, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.7252984505969012, - "heldout_inlier_rmse_m": 0.11644876240570266, - "rotation_invariant_error_deg": 0.22862044157476902, - "reverse_translation_m": 0.013002087545984397, - "reverse_rotation_deg": 0.11470841251550605, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.7555499175440822, - "heldout_inlier_rmse_m": 0.1089594430160029, - "rotation_invariant_error_deg": 0.1132500435389403, - "reverse_translation_m": 0.0044919719825295985, - "reverse_rotation_deg": 0.008669004448985662, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.7088209387190134, - "heldout_inlier_rmse_m": 0.11165869814478939, - "rotation_invariant_error_deg": 0.226031846282865, - "reverse_translation_m": 0.005265657588642687, - "reverse_rotation_deg": 0.10195131255569051, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 26, - "heldout_inlier_ratio": 0.6831820474029249, - "heldout_inlier_rmse_m": 0.11509847268437542, - "rotation_invariant_error_deg": 0.16487240630993938, - "reverse_translation_m": 0.010313466929779696, - "reverse_rotation_deg": 0.02189018950989812, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 22, - "j": 27, - "heldout_inlier_ratio": 0.712325317889966, - "heldout_inlier_rmse_m": 0.11297739003609018, - "rotation_invariant_error_deg": 0.05141916421773374, - "reverse_translation_m": 0.006473104665270118, - "reverse_rotation_deg": 0.07627008321159866, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.787546254944494, - "heldout_inlier_rmse_m": 0.11112536909525574, - "rotation_invariant_error_deg": 0.292784484398112, - "reverse_translation_m": 0.003984385308883342, - "reverse_rotation_deg": 0.012875657690538275, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.6839640551828883, - "heldout_inlier_rmse_m": 0.11561487899989795, - "rotation_invariant_error_deg": 0.4093683490195019, - "reverse_translation_m": 0.009663940236368565, - "reverse_rotation_deg": 0.2587163051792124, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6214811057570377, - "heldout_inlier_rmse_m": 0.12356096223549605, - "rotation_invariant_error_deg": 0.34257185392186784, - "reverse_translation_m": 0.03346639663911815, - "reverse_rotation_deg": 0.040359288659068966, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 27, - "heldout_inlier_ratio": 0.6439154109155375, - "heldout_inlier_rmse_m": 0.11883308044324468, - "rotation_invariant_error_deg": 0.12503465743552056, - "reverse_translation_m": 0.01363202571969651, - "reverse_rotation_deg": 0.268813724284828, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 28, - "heldout_inlier_ratio": 0.5551750380517504, - "heldout_inlier_rmse_m": 0.13104613123848732, - "rotation_invariant_error_deg": 0.6545193183589504, - "reverse_translation_m": 0.01592501575703795, - "reverse_rotation_deg": 0.1925228188054137, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.7610619469026548, - "heldout_inlier_rmse_m": 0.10446971824743242, - "rotation_invariant_error_deg": 0.10557876305168179, - "reverse_translation_m": 0.01721789520038266, - "reverse_rotation_deg": 0.09266069416139829, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.6986700443318556, - "heldout_inlier_rmse_m": 0.11795525471114342, - "rotation_invariant_error_deg": 0.03781347168970228, - "reverse_translation_m": 0.0239438468814135, - "reverse_rotation_deg": 0.2700005297192175, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.7233746521629142, - "heldout_inlier_rmse_m": 0.11505806966234582, - "rotation_invariant_error_deg": 0.19758143732377675, - "reverse_translation_m": 0.0071603040929797065, - "reverse_rotation_deg": 0.1144565168286882, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 28, - "heldout_inlier_ratio": 0.618522741669834, - "heldout_inlier_rmse_m": 0.1218895746871147, - "rotation_invariant_error_deg": 0.3274084307904701, - "reverse_translation_m": 0.008956300116613691, - "reverse_rotation_deg": 0.24319664279778394, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 29, - "heldout_inlier_ratio": 0.7635993899339095, - "heldout_inlier_rmse_m": 0.11147922533242269, - "rotation_invariant_error_deg": 0.34482282494771255, - "reverse_translation_m": 0.02246832420061709, - "reverse_rotation_deg": 0.4519372330281508, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.8176906646563639, - "heldout_inlier_rmse_m": 0.1076748622762494, - "rotation_invariant_error_deg": 0.06752843484522941, - "reverse_translation_m": 0.011727583881002021, - "reverse_rotation_deg": 0.04299213457608308, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.8508155583437892, - "heldout_inlier_rmse_m": 0.10177690901936605, - "rotation_invariant_error_deg": 0.30039622567666413, - "reverse_translation_m": 0.004921098494284399, - "reverse_rotation_deg": 0.04722324529000337, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "heldout_inlier_ratio": 0.6552720874701521, - "heldout_inlier_rmse_m": 0.1158307449607044, - "rotation_invariant_error_deg": 0.21903719892409867, - "reverse_translation_m": 0.010027166778796438, - "reverse_rotation_deg": 0.069841684352646, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 29, - "heldout_inlier_ratio": 0.7434442763489663, - "heldout_inlier_rmse_m": 0.11227320270489505, - "rotation_invariant_error_deg": 0.4508255913860353, - "reverse_translation_m": 0.005744598995027529, - "reverse_rotation_deg": 0.30413185830684, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 30, - "heldout_inlier_ratio": 0.7986111111111112, - "heldout_inlier_rmse_m": 0.1061010900656728, - "rotation_invariant_error_deg": 0.228914420797949, - "reverse_translation_m": 0.004651476537899485, - "reverse_rotation_deg": 0.06337779258524685, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.8835952231301069, - "heldout_inlier_rmse_m": 0.10164781558403184, - "rotation_invariant_error_deg": 0.25153580267632236, - "reverse_translation_m": 0.0010243697887392141, - "reverse_rotation_deg": 0.04630474119881922, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.7013346764039284, - "heldout_inlier_rmse_m": 0.1156303654422143, - "rotation_invariant_error_deg": 0.2972915438355699, - "reverse_translation_m": 0.016692399239017493, - "reverse_rotation_deg": 0.1408617368634082, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "heldout_inlier_ratio": 0.7255273462170014, - "heldout_inlier_rmse_m": 0.11343814488049828, - "rotation_invariant_error_deg": 0.38275266436673405, - "reverse_translation_m": 0.0030631045126193056, - "reverse_rotation_deg": 0.10499072900350268, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 30, - "heldout_inlier_ratio": 0.7273877292852625, - "heldout_inlier_rmse_m": 0.11178149175643984, - "rotation_invariant_error_deg": 0.29587955343367867, - "reverse_translation_m": 0.002906139936114469, - "reverse_rotation_deg": 0.06343916895540856, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 31, - "heldout_inlier_ratio": 0.6099962135554714, - "heldout_inlier_rmse_m": 0.12348129729633385, - "rotation_invariant_error_deg": 0.33103556532967104, - "reverse_translation_m": 0.011230201352754812, - "reverse_rotation_deg": 0.02547666380871279, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.7116811266188859, - "heldout_inlier_rmse_m": 0.11387091842867321, - "rotation_invariant_error_deg": 0.5165498736447489, - "reverse_translation_m": 0.011430300098438593, - "reverse_rotation_deg": 0.17858658887118406, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7588294651866802, - "heldout_inlier_rmse_m": 0.10898351788466304, - "rotation_invariant_error_deg": 0.1533714205044987, - "reverse_translation_m": 0.002552411031283606, - "reverse_rotation_deg": 0.096053889700167, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "heldout_inlier_ratio": 0.7699595755432036, - "heldout_inlier_rmse_m": 0.10809432324457112, - "rotation_invariant_error_deg": 0.5445822636501703, - "reverse_translation_m": 0.006419845852952349, - "reverse_rotation_deg": 0.09683669503892821, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 31, - "heldout_inlier_ratio": 0.6407864885303756, - "heldout_inlier_rmse_m": 0.12195597170279295, - "rotation_invariant_error_deg": 0.11675603348386687, - "reverse_translation_m": 0.03203829198983217, - "reverse_rotation_deg": 0.21314212616538905, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 27, - "j": 32, - "heldout_inlier_ratio": 0.6120722798923491, - "heldout_inlier_rmse_m": 0.12793570356778294, - "rotation_invariant_error_deg": 0.020817685175060774, - "reverse_translation_m": 0.02476270066797521, - "reverse_rotation_deg": 0.18953242722457034, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.6751737207833228, - "heldout_inlier_rmse_m": 0.11816626627973714, - "rotation_invariant_error_deg": 0.6787281995065513, - "reverse_translation_m": 0.0036062245918322845, - "reverse_rotation_deg": 0.04228106700822467, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 30, - "heldout_inlier_ratio": 0.6476021763887132, - "heldout_inlier_rmse_m": 0.12162303323930705, - "rotation_invariant_error_deg": 0.0011426136672270104, - "reverse_translation_m": 0.036760870155111036, - "reverse_rotation_deg": 0.061189777619461184, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 28, - "j": 31, - "heldout_inlier_ratio": 0.558515338972352, - "heldout_inlier_rmse_m": 0.1324943729180927, - "rotation_invariant_error_deg": 0.6813352681799607, - "reverse_translation_m": 0.011294835537302048, - "reverse_rotation_deg": 0.22869636591571527, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 28, - "j": 32, - "heldout_inlier_ratio": 0.5356867779204108, - "heldout_inlier_rmse_m": 0.13793317141107478, - "rotation_invariant_error_deg": 0.4663545479243858, - "reverse_translation_m": 0.009260784922164039, - "reverse_rotation_deg": 0.4736145985672847, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 28, - "j": 33, - "heldout_inlier_ratio": 0.49968659897204465, - "heldout_inlier_rmse_m": 0.13776776698165452, - "rotation_invariant_error_deg": 0.7357846623448125, - "reverse_translation_m": 0.03480709552965627, - "reverse_rotation_deg": 0.1328751318540718, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 29, - "j": 30, - "heldout_inlier_ratio": 0.8126428027418127, - "heldout_inlier_rmse_m": 0.11465616151168853, - "rotation_invariant_error_deg": 0.6822378331671111, - "reverse_translation_m": 0.059123063905753705, - "reverse_rotation_deg": 0.35885997079417975, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 29, - "j": 31, - "heldout_inlier_ratio": 0.7178318135764944, - "heldout_inlier_rmse_m": 0.11831514282300001, - "rotation_invariant_error_deg": 2.223316258664482, - "reverse_translation_m": 0.03055388488044922, - "reverse_rotation_deg": 0.16788276176822323, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 29, - "j": 32, - "heldout_inlier_ratio": 0.6866709594333548, - "heldout_inlier_rmse_m": 0.12344589693451308, - "rotation_invariant_error_deg": 0.1841409924921109, - "reverse_translation_m": 0.01847461637742171, - "reverse_rotation_deg": 0.10764991453418553, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 29, - "j": 33, - "heldout_inlier_ratio": 0.6151911468812877, - "heldout_inlier_rmse_m": 0.12607024585552623, - "rotation_invariant_error_deg": 0.05768214856408349, - "reverse_translation_m": 0.005640558537625966, - "reverse_rotation_deg": 0.060018922799470055, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 29, - "j": 34, - "heldout_inlier_ratio": 0.6489454636216149, - "heldout_inlier_rmse_m": 0.1229782406905996, - "rotation_invariant_error_deg": 2.1175232490122653e-05, - "reverse_translation_m": 0.024951598645873194, - "reverse_rotation_deg": 0.20519725330906424, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.76103500761035, - "heldout_inlier_rmse_m": 0.11418966560335815, - "rotation_invariant_error_deg": 0.6273679415897782, - "reverse_translation_m": 0.010805499433410783, - "reverse_rotation_deg": 0.0764328342532002, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.7051463949438926, - "heldout_inlier_rmse_m": 0.11749249261595905, - "rotation_invariant_error_deg": 0.5155831180075268, - "reverse_translation_m": 0.009422682577629085, - "reverse_rotation_deg": 0.037900377279079585, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "heldout_inlier_ratio": 0.6064231738035264, - "heldout_inlier_rmse_m": 0.12368925274094972, - "rotation_invariant_error_deg": 0.7370075695237546, - "reverse_translation_m": 0.0147669225762263, - "reverse_rotation_deg": 0.09037435316445036, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 35, - "heldout_inlier_ratio": 0.690784364483562, - "heldout_inlier_rmse_m": 0.12252550482763978, - "rotation_invariant_error_deg": 0.5994829802016, - "reverse_translation_m": 0.009824737708452339, - "reverse_rotation_deg": 0.14818916841264132, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.7959078625659504, - "heldout_inlier_rmse_m": 0.10965414855273443, - "rotation_invariant_error_deg": 0.11934495957821412, - "reverse_translation_m": 0.009608345699366565, - "reverse_rotation_deg": 0.04073745185785107, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "heldout_inlier_ratio": 0.636089469716009, - "heldout_inlier_rmse_m": 0.11810494837446742, - "rotation_invariant_error_deg": 0.1213925755165377, - "reverse_translation_m": 0.01055590691460776, - "reverse_rotation_deg": 0.06271370554561609, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 31, - "j": 34, - "heldout_inlier_ratio": 0.6599326599326599, - "heldout_inlier_rmse_m": 0.11513164519765848, - "rotation_invariant_error_deg": 0.06230222411585373, - "reverse_translation_m": 0.002580333972310516, - "reverse_rotation_deg": 0.03476275200242535, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 31, - "j": 35, - "heldout_inlier_ratio": 0.7747933884297521, - "heldout_inlier_rmse_m": 0.1099315236542533, - "rotation_invariant_error_deg": 0.03126953049547865, - "reverse_translation_m": 0.002969158365974405, - "reverse_rotation_deg": 0.02482993261597952, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 36, - "heldout_inlier_ratio": 0.79326799071447, - "heldout_inlier_rmse_m": 0.11165900641583826, - "rotation_invariant_error_deg": 0.058872084873172525, - "reverse_translation_m": 0.004151989866605975, - "reverse_rotation_deg": 0.032942374858786365, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 33, - "heldout_inlier_ratio": 0.7479238533282229, - "heldout_inlier_rmse_m": 0.1140254726045761, - "rotation_invariant_error_deg": 0.22860158855181112, - "reverse_translation_m": 0.005854383016193307, - "reverse_rotation_deg": 0.042356141718508426, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 34, - "heldout_inlier_ratio": 0.7426470588235294, - "heldout_inlier_rmse_m": 0.11481351455228676, - "rotation_invariant_error_deg": 0.1912439478564636, - "reverse_translation_m": 0.0025843844761028077, - "reverse_rotation_deg": 0.009064526838353553, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 35, - "heldout_inlier_ratio": 0.8209641402863523, - "heldout_inlier_rmse_m": 0.10635864973089924, - "rotation_invariant_error_deg": 0.10556024521281415, - "reverse_translation_m": 0.004447738370013908, - "reverse_rotation_deg": 0.11616784364821804, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 36, - "heldout_inlier_ratio": 0.7613800341073068, - "heldout_inlier_rmse_m": 0.10898930843612145, - "rotation_invariant_error_deg": 0.08391657324301605, - "reverse_translation_m": 0.008302372052489307, - "reverse_rotation_deg": 0.047221847858387886, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 37, - "heldout_inlier_ratio": 0.6919923126201153, - "heldout_inlier_rmse_m": 0.11497666348297753, - "rotation_invariant_error_deg": 0.11164571050544225, - "reverse_translation_m": 0.00567166990415677, - "reverse_rotation_deg": 0.10190182649448634, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 33, - "j": 34, - "heldout_inlier_ratio": 0.8247678018575851, - "heldout_inlier_rmse_m": 0.10774292174748101, - "rotation_invariant_error_deg": 0.0545355598919528, - "reverse_translation_m": 0.005218203824516851, - "reverse_rotation_deg": 0.054034410494683056, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 35, - "heldout_inlier_ratio": 0.7097435897435898, - "heldout_inlier_rmse_m": 0.11216257584808116, - "rotation_invariant_error_deg": 0.16610087955172048, - "reverse_translation_m": 0.0055472051152683725, - "reverse_rotation_deg": 0.06161504272529624, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 33, - "j": 36, - "heldout_inlier_ratio": 0.62202304737516, - "heldout_inlier_rmse_m": 0.11282494351568334, - "rotation_invariant_error_deg": 0.19275099091922243, - "reverse_translation_m": 0.009207361872581905, - "reverse_rotation_deg": 0.07430583689659953, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 33, - "j": 37, - "heldout_inlier_ratio": 0.6328828828828829, - "heldout_inlier_rmse_m": 0.12540757119118434, - "rotation_invariant_error_deg": 0.3363578632596642, - "reverse_translation_m": 0.0036940550280262596, - "reverse_rotation_deg": 0.12927083795080543, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 34, - "j": 35, - "heldout_inlier_ratio": 0.7146673451214858, - "heldout_inlier_rmse_m": 0.11428688542425412, - "rotation_invariant_error_deg": 0.13206315747002506, - "reverse_translation_m": 0.013436446539858737, - "reverse_rotation_deg": 0.05510481554154184, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 34, - "j": 37, - "heldout_inlier_ratio": 0.6899292189246243, - "heldout_inlier_rmse_m": 0.11937420197560855, - "rotation_invariant_error_deg": 0.28054363614448263, - "reverse_translation_m": 0.005083360744530967, - "reverse_rotation_deg": 0.10024940937419655, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 35, - "j": 36, - "heldout_inlier_ratio": 0.8242496050552922, - "heldout_inlier_rmse_m": 0.10907898456971946, - "rotation_invariant_error_deg": 0.015669945684166464, - "reverse_translation_m": 0.0026096461304541156, - "reverse_rotation_deg": 0.07595057929078583, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 35, - "j": 37, - "heldout_inlier_ratio": 0.6924659295448702, - "heldout_inlier_rmse_m": 0.12103303062396852, - "rotation_invariant_error_deg": 0.07407157696091238, - "reverse_translation_m": 0.005914867863779407, - "reverse_rotation_deg": 0.06573359298031699, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 36, - "j": 37, - "heldout_inlier_ratio": 0.6402157164869029, - "heldout_inlier_rmse_m": 0.12413886977390769, - "rotation_invariant_error_deg": 0.07360543721028989, - "reverse_translation_m": 0.008397869289519334, - "reverse_rotation_deg": 0.08479281990151419, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - } - ] -} diff --git a/results/01_previous_two_batches/small_gicp/batch1_auxiliary_check.json b/results/01_previous_two_batches/small_gicp/batch1_auxiliary_check.json deleted file mode 100644 index 12e6e4b..0000000 --- a/results/01_previous_two_batches/small_gicp/batch1_auxiliary_check.json +++ /dev/null @@ -1,277 +0,0 @@ -{ - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": true, - "note": "No AX residual was used to select these pairs", - "stations": 38, - "metrics": { - "pairs": 36, - "translation_m": { - "rms": 0.07402020402512643, - "median": 0.05314343925871579, - "p90": 0.1272969635290951, - "p95": 0.14147696290683623, - "max": 0.15743855349684896 - }, - "rotation_deg": { - "rms": 1.1492603033421918, - "median": 0.8694109171568597, - "p90": 1.8257616608147966, - "p95": 1.9151501783565152, - "max": 2.3872345295181554 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.026175149113866782, - "rotation_deg": 0.6391104344821068, - "i": 0, - "j": 1 - }, - { - "pair_index": 1, - "translation_m": 0.05399080656776795, - "rotation_deg": 0.7503462279599024, - "i": 0, - "j": 3 - }, - { - "pair_index": 2, - "translation_m": 0.05685955205113222, - "rotation_deg": 1.7528510918025244, - "i": 1, - "j": 2 - }, - { - "pair_index": 3, - "translation_m": 0.04386400899992785, - "rotation_deg": 1.8467495197498804, - "i": 2, - "j": 3 - }, - { - "pair_index": 4, - "translation_m": 0.05626077366726556, - "rotation_deg": 0.8079113372879332, - "i": 2, - "j": 5 - }, - { - "pair_index": 5, - "translation_m": 0.09087008636486496, - "rotation_deg": 1.026687291127638, - "i": 3, - "j": 4 - }, - { - "pair_index": 6, - "translation_m": 0.011511013157318718, - "rotation_deg": 0.19484251468537728, - "i": 3, - "j": 5 - }, - { - "pair_index": 7, - "translation_m": 0.07294571613929493, - "rotation_deg": 0.8223795285339977, - "i": 4, - "j": 5 - }, - { - "pair_index": 8, - "translation_m": 0.03068183988034665, - "rotation_deg": 0.28683040898343787, - "i": 5, - "j": 6 - }, - { - "pair_index": 9, - "translation_m": 0.04275223212349703, - "rotation_deg": 0.701351776008062, - "i": 6, - "j": 7 - }, - { - "pair_index": 10, - "translation_m": 0.04932770426469867, - "rotation_deg": 0.6710714316916605, - "i": 6, - "j": 9 - }, - { - "pair_index": 11, - "translation_m": 0.04132200915104361, - "rotation_deg": 1.0591594894230583, - "i": 11, - "j": 12 - }, - { - "pair_index": 12, - "translation_m": 0.05457596514011665, - "rotation_deg": 1.9025587382160285, - "i": 16, - "j": 17 - }, - { - "pair_index": 13, - "translation_m": 0.1444364884565483, - "rotation_deg": 0.878734531814174, - "i": 17, - "j": 18 - }, - { - "pair_index": 14, - "translation_m": 0.08666942413173652, - "rotation_deg": 0.8560485527931129, - "i": 18, - "j": 19 - }, - { - "pair_index": 15, - "translation_m": 0.1401188917021612, - "rotation_deg": 1.596129012793476, - "i": 18, - "j": 21 - }, - { - "pair_index": 16, - "translation_m": 0.015218472185905801, - "rotation_deg": 1.3639536065690272, - "i": 20, - "j": 21 - }, - { - "pair_index": 17, - "translation_m": 0.044288628737202185, - "rotation_deg": 0.24234091190374474, - "i": 20, - "j": 22 - }, - { - "pair_index": 18, - "translation_m": 0.041873719472882466, - "rotation_deg": 0.8630111615428633, - "i": 20, - "j": 23 - }, - { - "pair_index": 19, - "translation_m": 0.04766076872791419, - "rotation_deg": 1.592170300445217, - "i": 21, - "j": 22 - }, - { - "pair_index": 20, - "translation_m": 0.06407386924590294, - "rotation_deg": 0.6604716233222132, - "i": 21, - "j": 24 - }, - { - "pair_index": 21, - "translation_m": 0.04694855582296258, - "rotation_deg": 0.49059371565968823, - "i": 22, - "j": 23 - }, - { - "pair_index": 22, - "translation_m": 0.01699246526900484, - "rotation_deg": 1.4341910287168735, - "i": 22, - "j": 24 - }, - { - "pair_index": 23, - "translation_m": 0.05229607194966363, - "rotation_deg": 1.120879367830044, - "i": 23, - "j": 24 - }, - { - "pair_index": 24, - "translation_m": 0.020810043376301643, - "rotation_deg": 0.5009109191051434, - "i": 24, - "j": 25 - }, - { - "pair_index": 25, - "translation_m": 0.043831190745566344, - "rotation_deg": 0.47571695708233286, - "i": 24, - "j": 26 - }, - { - "pair_index": 26, - "translation_m": 0.11447503535602893, - "rotation_deg": 0.9257799651614966, - "i": 25, - "j": 26 - }, - { - "pair_index": 27, - "translation_m": 0.061431194585866364, - "rotation_deg": 1.8047738018797126, - "i": 27, - "j": 28 - }, - { - "pair_index": 28, - "translation_m": 0.09966331456020154, - "rotation_deg": 1.9529244987779755, - "i": 27, - "j": 29 - }, - { - "pair_index": 29, - "translation_m": 0.07785577496744421, - "rotation_deg": 0.5145378388092755, - "i": 28, - "j": 29 - }, - { - "pair_index": 30, - "translation_m": 0.14049045439026553, - "rotation_deg": 0.83303218231006, - "i": 30, - "j": 31 - }, - { - "pair_index": 31, - "translation_m": 0.11441845590035929, - "rotation_deg": 0.8758106727708561, - "i": 30, - "j": 33 - }, - { - "pair_index": 32, - "translation_m": 0.15743855349684896, - "rotation_deg": 0.5956528317274336, - "i": 33, - "j": 35 - }, - { - "pair_index": 33, - "translation_m": 0.05714959629699741, - "rotation_deg": 0.9388591914539489, - "i": 34, - "j": 35 - }, - { - "pair_index": 34, - "translation_m": 0.019561513757857227, - "rotation_deg": 2.3872345295181554, - "i": 34, - "j": 37 - }, - { - "pair_index": 35, - "translation_m": 0.04089150700945596, - "rotation_deg": 1.264595889658635, - "i": 35, - "j": 36 - } - ] - } -} diff --git a/results/01_previous_two_batches/small_gicp/extrinsic_batch2.json b/results/01_previous_two_batches/small_gicp/extrinsic_batch2.json deleted file mode 100644 index 6688257..0000000 --- a/results/01_previous_two_batches/small_gicp/extrinsic_batch2.json +++ /dev/null @@ -1,974 +0,0 @@ -{ - "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 - ] - } -} diff --git a/results/01_previous_two_batches/small_gicp/extrinsic_batch2_refined.json b/results/01_previous_two_batches/small_gicp/extrinsic_batch2_refined.json deleted file mode 100644 index fc6b6f7..0000000 --- a/results/01_previous_two_batches/small_gicp/extrinsic_batch2_refined.json +++ /dev/null @@ -1,604 +0,0 @@ -{ - "schema_version": 2, - "success": true, - "message": "Both `ftol` and `xtol` termination conditions are 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.2996301155160686, - -0.0035647011612625953, - 0.7218861757826791 - ], - "rotation_rpy_deg_xyz": [ - -0.7871563544979889, - 1.1414557494228486, - -0.9357571721886107 - ], - "quaternion_xyzw": [ - -0.00678727299452357, - 0.010016439179525593, - -0.008096912246155998, - 0.9998940163254998 - ], - "matrix_4x4": [ - [ - 0.9996682219164817, - 0.01605613959699911, - 0.02014066710864661, - 1.2996301155160686 - ], - [ - -0.016328076825577065, - 0.9997767458747517, - 0.013410902850672373, - -0.0035647011612625953 - ], - [ - -0.019920843293337136, - -0.01373531176689472, - 0.9997072077429213, - 0.7218861757826791 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 38, - "pairs": 80, - "residuals": { - "pairs": 80, - "translation_m": { - "rms": 0.11870623426762615, - "median": 0.06068763803103021, - "p90": 0.19284315530447813, - "p95": 0.23754716587335756, - "max": 0.38871430386214717 - }, - "rotation_deg": { - "rms": 1.135091439337232, - "median": 0.9273339494951451, - "p90": 1.649541165022219, - "p95": 1.981621584559613, - "max": 2.6935053979880266 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.09187263959310249, - "rotation_deg": 0.38130732180446597 - }, - { - "pair_index": 1, - "translation_m": 0.1769336788939164, - "rotation_deg": 0.6450700969822144 - }, - { - "pair_index": 2, - "translation_m": 0.15700274999733538, - "rotation_deg": 0.5067710073297588 - }, - { - "pair_index": 3, - "translation_m": 0.10662491066187467, - "rotation_deg": 0.5429917463514751 - }, - { - "pair_index": 4, - "translation_m": 0.029628667721179554, - "rotation_deg": 0.5509223411600718 - }, - { - "pair_index": 5, - "translation_m": 0.0843749108812327, - "rotation_deg": 0.4940771462459488 - }, - { - "pair_index": 6, - "translation_m": 0.07914868235296937, - "rotation_deg": 0.8254472643593804 - }, - { - "pair_index": 7, - "translation_m": 0.009453498887768107, - "rotation_deg": 0.9043821535551515 - }, - { - "pair_index": 8, - "translation_m": 0.019511765564918175, - "rotation_deg": 0.3967737125225238 - }, - { - "pair_index": 9, - "translation_m": 0.05341682547424797, - "rotation_deg": 1.2338229281598583 - }, - { - "pair_index": 10, - "translation_m": 0.07322963958641442, - "rotation_deg": 1.6425496017479204 - }, - { - "pair_index": 11, - "translation_m": 0.05907844745776598, - "rotation_deg": 0.9099755792395827 - }, - { - "pair_index": 12, - "translation_m": 0.07907007871308952, - "rotation_deg": 1.294221003621915 - }, - { - "pair_index": 13, - "translation_m": 0.02140092032185309, - "rotation_deg": 0.5139343819205795 - }, - { - "pair_index": 14, - "translation_m": 0.19209639243977228, - "rotation_deg": 0.9890356204602867 - }, - { - "pair_index": 15, - "translation_m": 0.23611357668308347, - "rotation_deg": 0.7834325452898548 - }, - { - "pair_index": 16, - "translation_m": 0.023285251634710107, - "rotation_deg": 0.17520547335389194 - }, - { - "pair_index": 17, - "translation_m": 0.26478536048856705, - "rotation_deg": 0.710271315591521 - }, - { - "pair_index": 18, - "translation_m": 0.16006553402191026, - "rotation_deg": 0.957610910483182 - }, - { - "pair_index": 19, - "translation_m": 0.027251092891380724, - "rotation_deg": 0.9157938224757094 - }, - { - "pair_index": 20, - "translation_m": 0.04027747409562381, - "rotation_deg": 0.5934052344689098 - }, - { - "pair_index": 21, - "translation_m": 0.009702766313815113, - "rotation_deg": 0.8792062492068344 - }, - { - "pair_index": 22, - "translation_m": 0.19956402108683025, - "rotation_deg": 1.302707349930284 - }, - { - "pair_index": 23, - "translation_m": 0.22208667994405493, - "rotation_deg": 0.865060603092117 - }, - { - "pair_index": 24, - "translation_m": 0.04688877706330616, - "rotation_deg": 0.35495594456572455 - }, - { - "pair_index": 25, - "translation_m": 0.14151886488940063, - "rotation_deg": 0.6501219960603252 - }, - { - "pair_index": 26, - "translation_m": 0.0884069047402769, - "rotation_deg": 0.7969404276735993 - }, - { - "pair_index": 27, - "translation_m": 0.16408056565265292, - "rotation_deg": 2.4437963646244074 - }, - { - "pair_index": 28, - "translation_m": 0.028664980727987763, - "rotation_deg": 1.008490254813876 - }, - { - "pair_index": 29, - "translation_m": 0.07072061490599325, - "rotation_deg": 1.909748472867515 - }, - { - "pair_index": 30, - "translation_m": 0.022948436582833444, - "rotation_deg": 2.3225092779351595 - }, - { - "pair_index": 31, - "translation_m": 0.38849552688092603, - "rotation_deg": 1.2325430499166412 - }, - { - "pair_index": 32, - "translation_m": 0.06230564324556168, - "rotation_deg": 1.4474405187186974 - }, - { - "pair_index": 33, - "translation_m": 0.017320969569104998, - "rotation_deg": 1.9636801270135327 - }, - { - "pair_index": 34, - "translation_m": 0.15793386431764098, - "rotation_deg": 1.0830036872759303 - }, - { - "pair_index": 35, - "translation_m": 0.38871430386214717, - "rotation_deg": 0.6522443164627029 - }, - { - "pair_index": 36, - "translation_m": 0.06172089136639702, - "rotation_deg": 2.6935053979880266 - }, - { - "pair_index": 37, - "translation_m": 0.1887406405132845, - "rotation_deg": 0.5255100746087121 - }, - { - "pair_index": 38, - "translation_m": 0.3189860513403679, - "rotation_deg": 0.33497034772867773 - }, - { - "pair_index": 39, - "translation_m": 0.08451339501338925, - "rotation_deg": 2.6477889534666375 - }, - { - "pair_index": 40, - "translation_m": 0.21900981683029178, - "rotation_deg": 1.2331847283146662 - }, - { - "pair_index": 41, - "translation_m": 0.1713522910564131, - "rotation_deg": 1.183067166836572 - }, - { - "pair_index": 42, - "translation_m": 0.0512348407217562, - "rotation_deg": 0.6012483843007921 - }, - { - "pair_index": 43, - "translation_m": 0.07445293169404418, - "rotation_deg": 1.1211247122462373 - }, - { - "pair_index": 44, - "translation_m": 0.04410762061472433, - "rotation_deg": 0.6590595108738039 - }, - { - "pair_index": 45, - "translation_m": 0.033089648474152494, - "rotation_deg": 1.0312870469391562 - }, - { - "pair_index": 46, - "translation_m": 0.06760165724961124, - "rotation_deg": 0.4565827539034035 - }, - { - "pair_index": 47, - "translation_m": 0.025670738208830455, - "rotation_deg": 1.4302485146055521 - }, - { - "pair_index": 48, - "translation_m": 0.028147203494591596, - "rotation_deg": 1.830717268006061 - }, - { - "pair_index": 49, - "translation_m": 0.02266261366157945, - "rotation_deg": 0.946299184254386 - }, - { - "pair_index": 50, - "translation_m": 0.04935636595094902, - "rotation_deg": 1.3964539171127066 - }, - { - "pair_index": 51, - "translation_m": 0.05889812376302877, - "rotation_deg": 1.4698930638008505 - }, - { - "pair_index": 52, - "translation_m": 0.05965438469566341, - "rotation_deg": 0.9816847661944946 - }, - { - "pair_index": 53, - "translation_m": 0.06606854020326042, - "rotation_deg": 0.27458915782550086 - }, - { - "pair_index": 54, - "translation_m": 0.05158448025659227, - "rotation_deg": 0.9388740765145809 - }, - { - "pair_index": 55, - "translation_m": 0.07186821989401924, - "rotation_deg": 0.7757369232394653 - }, - { - "pair_index": 56, - "translation_m": 0.08608318124462912, - "rotation_deg": 0.30616875771444013 - }, - { - "pair_index": 57, - "translation_m": 0.06688749012833557, - "rotation_deg": 0.5486461025019678 - }, - { - "pair_index": 58, - "translation_m": 0.05762085648043371, - "rotation_deg": 1.372519412009814 - }, - { - "pair_index": 59, - "translation_m": 0.031564793498850025, - "rotation_deg": 0.4468008042798917 - }, - { - "pair_index": 60, - "translation_m": 0.039910793641719705, - "rotation_deg": 0.7939954067942764 - }, - { - "pair_index": 61, - "translation_m": 0.04407888801173494, - "rotation_deg": 1.3107090439391704 - }, - { - "pair_index": 62, - "translation_m": 0.024691509543671615, - "rotation_deg": 1.236002055213775 - }, - { - "pair_index": 63, - "translation_m": 0.02262539867961735, - "rotation_deg": 0.5097286713719923 - }, - { - "pair_index": 64, - "translation_m": 0.12496365742733645, - "rotation_deg": 1.7124652344909004 - }, - { - "pair_index": 65, - "translation_m": 0.07938704275394372, - "rotation_deg": 1.136197571772474 - }, - { - "pair_index": 66, - "translation_m": 0.03041340784879668, - "rotation_deg": 1.1835741189420788 - }, - { - "pair_index": 67, - "translation_m": 0.08565781637557897, - "rotation_deg": 1.325342137093704 - }, - { - "pair_index": 68, - "translation_m": 0.06569851623164084, - "rotation_deg": 0.5889885968744448 - }, - { - "pair_index": 69, - "translation_m": 0.028714655898349907, - "rotation_deg": 0.6559696801898813 - }, - { - "pair_index": 70, - "translation_m": 0.06483297271989888, - "rotation_deg": 1.3915654660441625 - }, - { - "pair_index": 71, - "translation_m": 0.03452933204038689, - "rotation_deg": 0.8331166409438662 - }, - { - "pair_index": 72, - "translation_m": 0.026295103775966104, - "rotation_deg": 1.2325751495683674 - }, - { - "pair_index": 73, - "translation_m": 0.04043011893578754, - "rotation_deg": 1.2125523869736732 - }, - { - "pair_index": 74, - "translation_m": 0.04383537712573055, - "rotation_deg": 0.5600272304118834 - }, - { - "pair_index": 75, - "translation_m": 0.0849604176628602, - "rotation_deg": 1.2304564930488662 - }, - { - "pair_index": 76, - "translation_m": 0.010862365758746927, - "rotation_deg": 0.38357205151967033 - }, - { - "pair_index": 77, - "translation_m": 0.053059282511333926, - "rotation_deg": 0.9610287581424943 - }, - { - "pair_index": 78, - "translation_m": 0.04551226086388418, - "rotation_deg": 1.1597952394623392 - }, - { - "pair_index": 79, - "translation_m": 0.016850631999927004, - "rotation_deg": 0.7568718165305058 - } - ] - } - }, - "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.004217873072423743, - 0.004428061325180952, - 0.004921296107038976 - ], - "rotation_deg": [ - 0.04989765234702571, - 0.04568528000305764, - 0.12720936620845405 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.329566115808833, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 354.634716588624, - "success": true, - "translation_m": 3.20226506801652e-10, - "rotation_deg": 2.202963019076451e-08 - }, - { - "cost": 354.6347165886241, - "success": true, - "translation_m": 7.896781546182907e-10, - "rotation_deg": 1.0169266187599847e-07 - }, - { - "cost": 354.6347165886238, - "success": true, - "translation_m": 8.217931179403876e-10, - "rotation_deg": 6.93412504585164e-08 - }, - { - "cost": 354.6347165886237, - "success": true, - "translation_m": 3.469446951953614e-18, - "rotation_deg": 0.0 - }, - { - "cost": 354.6347165886238, - "success": true, - "translation_m": 1.3034248658026153e-10, - "rotation_deg": 2.7806728416619943e-08 - }, - { - "cost": 354.6347165886238, - "success": true, - "translation_m": 2.260359361733417e-10, - "rotation_deg": 2.6418689746833837e-08 - }, - { - "cost": 354.634716588624, - "success": true, - "translation_m": 7.589395457725227e-10, - "rotation_deg": 4.91609016107675e-08 - }, - { - "cost": 354.6347165886238, - "success": true, - "translation_m": 1.2750789560311927e-10, - "rotation_deg": 7.759775984980414e-10 - }, - { - "cost": 354.634716588624, - "success": true, - "translation_m": 7.805526908313695e-10, - "rotation_deg": 6.684488070039544e-08 - }, - { - "cost": 354.634716588624, - "success": true, - "translation_m": 7.763945275712574e-10, - "rotation_deg": 8.931061588988946e-08 - }, - { - "cost": 354.6347165886244, - "success": true, - "translation_m": 9.383630927674663e-10, - "rotation_deg": 1.3000921411943172e-07 - }, - { - "cost": 354.634716588624, - "success": true, - "translation_m": 6.944401937454179e-10, - "rotation_deg": 7.954648404736881e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.0017068433472663032, - 0.0019214288447692426, - 0.0013180801706094514, - 0.06849719260762097, - 0.05792635838163369, - 0.062093058432709465 - ], - "p025": [ - 1.2968099294514637, - -0.006751632579940086, - 0.7193267956198541, - -0.9300082754299475, - 1.0287033540941326, - -1.0774039892205403 - ], - "p975": [ - 1.302479553931627, - -0.0001961195897526885, - 0.7244258625906532, - -0.6646157463265417, - 1.254120304082275, - -0.8275267997610058 - ] - } -} diff --git a/results/02_data4_calibration/README.md b/results/02_data4_calibration/README.md deleted file mode 100644 index d0fcfe6..0000000 --- a/results/02_data4_calibration/README.md +++ /dev/null @@ -1,12 +0,0 @@ -# data4 独立标定结果 - -data4 含 34 个静止站点,LiDAR 来自逐站 dlog,RTK/IMU 来自独立 rscap。求解不使用手量外参初始化。 - -```text -translation_m = [1.300376020, -0.001706691, 0.704877045] -RPY_deg_xyz = [-0.791891617, 1.393823210, -0.970742631] -AX RMS = 0.11762 m / 1.24257 deg (26 pairs) -condition = 7.44293 -``` - -该结果用于独立对照,不是当前部署值。`final_extrinsic_data4.json` 与 `consensus/extrinsic.json` 数值相同;前者是便于下游读取的顶层副本。 diff --git a/results/02_data4_calibration/common/ground_planes.csv b/results/02_data4_calibration/common/ground_planes.csv deleted file mode 100644 index 565940d..0000000 --- a/results/02_data4_calibration/common/ground_planes.csv +++ /dev/null @@ -1,35 +0,0 @@ -time,nx,ny,nz,d,inliers,rms_m,frame_counter -1784783825.357129,-0.011572516208853837,-0.01546146293660183,0.9998134926237273,0.9428804652027359,2148,0.011933750988078078,382 -1784783905.353819,0.0037183584307534687,-0.006818427483323246,0.9999698409738341,0.9412842800288904,1992,0.011942807895967073,1182 -1784783971.0503054,-0.021709843154394736,-0.005232422217807239,0.999750621139065,0.9451429710867566,1863,0.012080615710528817,1839 -1784784059.7468228,-0.02414670904491499,-0.0009406084776101358,0.9997079832120939,0.9517260475425733,1921,0.013468410314875789,2726 -1784784149.2434597,-0.034005828386544125,0.003026503321489513,0.9994170520425345,0.9257219945735469,1673,0.012714432789206961,3621 -1784784224.2408776,-0.02761369891036776,0.0016288328836576937,0.9996173420544108,0.9001377900125058,1799,0.012615520511386497,4371 -1784784301.6372502,-0.0071762210837946405,-0.011511959356927467,0.9999079840878965,0.9580809447760092,2113,0.012007730376482893,5145 -1784784387.733771,-0.010489658730106238,-0.009076163262051764,0.9999037905319524,0.9306898458653136,2187,0.01214615852280608,6006 -1784784474.9314597,-0.016114135387570262,-0.0509432368134707,0.9985715403834008,0.9072229543504865,1894,0.012012086783846727,6878 -1784784549.4274275,-0.025174259196536854,-0.013435577824823405,0.9995927880504234,0.9410339772836553,1603,0.01154746446935748,7623 -1784784614.7244046,-0.03173300872144653,-0.01870285516152855,0.9993213794202,0.932566466561638,1970,0.01233410897082844,8276 -1784784682.921899,-0.022665842512528424,-0.02998919824936144,0.9992932040054899,0.9145231002636922,1663,0.012948552270457988,8958 -1784784758.8187964,-0.023688193326187944,-0.030852054660206355,0.9992432237549499,0.9349709939783197,1756,0.013443733500218538,9717 -1784784836.0155501,-0.018461711654128285,-0.02498001140817507,0.9995174656967467,0.94720244509644,2057,0.013445893726732725,10489 -1784784921.1126208,-0.01993595874096254,-0.02538449671402936,0.9994789566947642,0.9120981909462803,1822,0.012774262320504949,11340 -1784784992.709947,-0.017778693539407146,-0.026803117327322167,0.9994826216386005,0.9369057170493221,2114,0.012253841210002203,12056 -1784785067.6067727,-0.03766905893322114,-0.00624993226014667,0.9992707242513558,0.9491859078478477,1753,0.01368084681318558,12805 -1784785215.9006598,-0.023255779098430147,-0.030526061005580876,0.9992633928739754,0.9173759052467025,2145,0.012710466955150847,14288 -1784785296.4990919,-0.014034225033964978,-0.025014032112439084,0.9995885847313253,0.9275558675790446,2445,0.012495377814995792,15094 -1784785363.1952267,-0.03352240146955635,-0.008711847039715113,0.9993999961581301,0.9543448006240765,1968,0.01391585588879859,15761 -1784785434.592462,-0.016701702947054253,0.016663838961403298,0.9997216460544089,0.9289121671743757,1857,0.011181698281215124,16475 -1784785506.389296,-0.03393096202185679,-0.007325597743377637,0.9993973311120926,0.9387396500642948,1844,0.01340053385502904,17193 -1784785587.5863533,-0.03382019410288933,-0.0007820019558384217,0.9994276276668481,0.9255866795455666,1691,0.012723688174337812,18005 -1784785681.9825997,-0.03422781555599595,-0.019255467037831406,0.999228544243718,0.9454924962027047,1959,0.01264678059788212,18949 -1784785815.4779446,-0.0011902245774294716,-0.023262098479360813,0.9997286922659526,0.9523139768255908,2026,0.012446728838862407,20284 -1784785891.9768085,-0.02758114176328463,0.0022252358991911286,0.9996170911625244,0.9417694614877323,1551,0.012616490996777729,21049 -1784785967.8726046,-0.031038730802887403,-0.010699305087773895,0.9994609157244643,0.9511405539250901,1512,0.013166899954854165,21808 -1784786031.5701303,-0.023257481598180085,-0.0214545061132305,0.9994992714940555,0.9380611442094842,1555,0.013339981386836522,22445 -1784786087.9670725,-0.02720411594210121,-0.012536181034248165,0.9995512894498637,0.942804167293392,1531,0.013246549575843425,23009 -1784786160.8647907,-0.030839502708575457,0.06473269778477829,0.9974259886879789,1.0783938869067702,1436,0.010501132985089602,23738 -1784786252.6621523,-0.040972893104105006,-0.02082299858725662,0.9989432540242288,0.9524735117369321,1736,0.012945834939507173,24656 -1784786319.6581354,-0.029761355495275914,-0.026565272466750618,0.9992039571668294,0.9594371422885729,1571,0.013108184070957877,25326 -1784786396.7558627,-0.030769194030483185,-0.022645428394942407,0.9992699541522921,0.9756606317668476,1326,0.013202989492489907,26097 -1784786557.4492514,-0.019983269314458783,-0.016965365794746882,0.9996563636124948,0.9409853928234136,1228,0.013269243263785414,27704 diff --git a/results/02_data4_calibration/consensus/B_consensus.consensus.json b/results/02_data4_calibration/consensus/B_consensus.consensus.json deleted file mode 100644 index d6f7efb..0000000 --- a/results/02_data4_calibration/consensus/B_consensus.consensus.json +++ /dev/null @@ -1,340 +0,0 @@ -{ - "selection_is_X_independent": true, - "B_source": "Open3D; small_gicp is used only as an agreement gate", - "max_translation_m": 0.05, - "max_rotation_deg": 0.5, - "input_open3d_pairs": 42, - "accepted_pairs": 26, - "pairs": [ - { - "i": 0, - "j": 1, - "open3d_small_translation_m": 0.014276441704401843, - "open3d_small_rotation_deg": 0.61360593819684, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 0, - "j": 2, - "open3d_small_translation_m": 0.019952450418350955, - "open3d_small_rotation_deg": 0.1460927002571647, - "accepted": true, - "reason": "" - }, - { - "i": 1, - "j": 2, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 2, - "j": 3, - "open3d_small_translation_m": 0.02240729290024995, - "open3d_small_rotation_deg": 0.16748011698659707, - "accepted": true, - "reason": "" - }, - { - "i": 2, - "j": 5, - "open3d_small_translation_m": 0.0061616498009369, - "open3d_small_rotation_deg": 0.13760629005733752, - "accepted": true, - "reason": "" - }, - { - "i": 3, - "j": 5, - "open3d_small_translation_m": 0.03979893704050873, - "open3d_small_rotation_deg": 0.21317157512260582, - "accepted": true, - "reason": "" - }, - { - "i": 3, - "j": 6, - "open3d_small_translation_m": 0.012411893826144786, - "open3d_small_rotation_deg": 0.6409039547122976, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 5, - "j": 8, - "open3d_small_translation_m": 0.02304199707639382, - "open3d_small_rotation_deg": 0.37075901631515606, - "accepted": true, - "reason": "" - }, - { - "i": 6, - "j": 7, - "open3d_small_translation_m": 0.008481323658868146, - "open3d_small_rotation_deg": 0.2110246381252998, - "accepted": true, - "reason": "" - }, - { - "i": 6, - "j": 8, - "open3d_small_translation_m": 0.03928926702287607, - "open3d_small_rotation_deg": 0.3638880951335251, - "accepted": true, - "reason": "" - }, - { - "i": 7, - "j": 8, - "open3d_small_translation_m": 0.008121615288998074, - "open3d_small_rotation_deg": 0.6269514061788241, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 10, - "j": 11, - "open3d_small_translation_m": 0.021311366483594964, - "open3d_small_rotation_deg": 0.5895827931090624, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 12, - "j": 14, - "open3d_small_translation_m": 0.021593615635265958, - "open3d_small_rotation_deg": 0.28280557179019644, - "accepted": true, - "reason": "" - }, - { - "i": 12, - "j": 15, - "open3d_small_translation_m": 0.03680193420722766, - "open3d_small_rotation_deg": 0.560849139510841, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 13, - "j": 15, - "open3d_small_translation_m": 0.02340982602704091, - "open3d_small_rotation_deg": 0.5560478634176494, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 13, - "j": 16, - "open3d_small_translation_m": 0.027602744462628358, - "open3d_small_rotation_deg": 0.2529072067309942, - "accepted": true, - "reason": "" - }, - { - "i": 15, - "j": 16, - "open3d_small_translation_m": 0.0209082447077901, - "open3d_small_rotation_deg": 0.03400462126505844, - "accepted": true, - "reason": "" - }, - { - "i": 15, - "j": 17, - "open3d_small_translation_m": 0.04186146133502697, - "open3d_small_rotation_deg": 0.13358624916951176, - "accepted": true, - "reason": "" - }, - { - "i": 15, - "j": 18, - "open3d_small_translation_m": 0.014610177110996908, - "open3d_small_rotation_deg": 0.25378510251316655, - "accepted": true, - "reason": "" - }, - { - "i": 16, - "j": 19, - "open3d_small_translation_m": 0.012703728170382652, - "open3d_small_rotation_deg": 0.36607447371237334, - "accepted": true, - "reason": "" - }, - { - "i": 17, - "j": 18, - "open3d_small_translation_m": 0.03054772105829047, - "open3d_small_rotation_deg": 0.6293060553954827, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 21, - "j": 22, - "open3d_small_translation_m": 0.008438580476457845, - "open3d_small_rotation_deg": 0.15351253406054555, - "accepted": true, - "reason": "" - }, - { - "i": 21, - "j": 23, - "open3d_small_translation_m": 0.018479690388276085, - "open3d_small_rotation_deg": 0.5781174905909121, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 21, - "j": 24, - "open3d_small_translation_m": 0.031284642427708814, - "open3d_small_rotation_deg": 0.39218826727895556, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 23, - "open3d_small_translation_m": 0.011568269703658672, - "open3d_small_rotation_deg": 0.06135783639322868, - "accepted": true, - "reason": "" - }, - { - "i": 22, - "j": 25, - "open3d_small_translation_m": 0.041018828349300214, - "open3d_small_rotation_deg": 0.42033964239927313, - "accepted": true, - "reason": "" - }, - { - "i": 23, - "j": 24, - "open3d_small_translation_m": 0.009191025383393128, - "open3d_small_rotation_deg": 0.5691342385312416, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 25, - "j": 26, - "open3d_small_translation_m": 0.020915300595375722, - "open3d_small_rotation_deg": 0.48750667250286367, - "accepted": true, - "reason": "" - }, - { - "i": 25, - "j": 27, - "open3d_small_translation_m": 0.09632206662156453, - "open3d_small_rotation_deg": 0.36999381209651033, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 25, - "j": 28, - "open3d_small_translation_m": 0.030138112812714665, - "open3d_small_rotation_deg": 0.46587172800425714, - "accepted": true, - "reason": "" - }, - { - "i": 26, - "j": 27, - "open3d_small_translation_m": 0.010107572072066551, - "open3d_small_rotation_deg": 0.4201365669869145, - "accepted": true, - "reason": "" - }, - { - "i": 26, - "j": 28, - "open3d_small_translation_m": 0.006243998078354416, - "open3d_small_rotation_deg": 1.3246136424341453, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 26, - "j": 29, - "open3d_small_translation_m": 0.036178252863401886, - "open3d_small_rotation_deg": 0.2782366609124745, - "accepted": true, - "reason": "" - }, - { - "i": 27, - "j": 28, - "open3d_small_translation_m": 0.00854064689385523, - "open3d_small_rotation_deg": 0.36768009631129556, - "accepted": true, - "reason": "" - }, - { - "i": 27, - "j": 29, - "open3d_small_translation_m": 0.013991202401755857, - "open3d_small_rotation_deg": 0.43729057730087656, - "accepted": true, - "reason": "" - }, - { - "i": 28, - "j": 29, - "open3d_small_translation_m": 0.12711262123542336, - "open3d_small_rotation_deg": 0.923125258275691, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 28, - "j": 31, - "accepted": false, - "reason": "not_in_small_gicp_refined" - }, - { - "i": 29, - "j": 30, - "open3d_small_translation_m": 0.024384029932636327, - "open3d_small_rotation_deg": 0.4169363425835767, - "accepted": true, - "reason": "" - }, - { - "i": 29, - "j": 31, - "open3d_small_translation_m": 0.012379055939823663, - "open3d_small_rotation_deg": 0.2514662901219578, - "accepted": true, - "reason": "" - }, - { - "i": 30, - "j": 31, - "open3d_small_translation_m": 0.056474627862095485, - "open3d_small_rotation_deg": 0.6666837905087916, - "accepted": false, - "reason": "backend_disagreement" - }, - { - "i": 30, - "j": 32, - "open3d_small_translation_m": 0.015291330212417978, - "open3d_small_rotation_deg": 0.309282499387647, - "accepted": true, - "reason": "" - }, - { - "i": 31, - "j": 32, - "accepted": false, - "reason": "not_in_small_gicp_refined" - } - ] -} \ No newline at end of file diff --git a/results/02_data4_calibration/consensus/B_consensus.npz b/results/02_data4_calibration/consensus/B_consensus.npz deleted file mode 100644 index 251bd12..0000000 Binary files a/results/02_data4_calibration/consensus/B_consensus.npz and /dev/null differ diff --git a/results/02_data4_calibration/consensus/extrinsic.json b/results/02_data4_calibration/consensus/extrinsic.json deleted file mode 100644 index 2bfd4ce..0000000 --- a/results/02_data4_calibration/consensus/extrinsic.json +++ /dev/null @@ -1,334 +0,0 @@ -{ - "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.3003760202954853, - -0.001706690964618711, - 0.7048770452870675 - ], - "rotation_rpy_deg_xyz": [ - -0.7918916173570606, - 1.3938232102436765, - -0.9707426305626278 - ], - "quaternion_xyzw": [ - -0.006806709954738454, - 0.01222091143708808, - -0.008386347182892065, - 0.9998669847555559 - ], - "matrix_4x4": [ - [ - 0.9995606370091497, - 0.016604094942673456, - 0.024552738604839263, - 1.3003760202954853 - ], - [ - -0.016936831740812692, - 0.9997666757610401, - 0.01340663150469432, - -0.001706690964618711 - ], - [ - -0.02432440487342451, - -0.013816586729505535, - 0.9996086360464778, - 0.7048770452870675 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 34, - "pairs": 26, - "residuals": { - "pairs": 26, - "translation_m": { - "rms": 0.11761746401526753, - "median": 0.05973702338495346, - "p90": 0.12346154791373619, - "p95": 0.2642880752048252, - "max": 0.38818289084930874 - }, - "rotation_deg": { - "rms": 1.2425719632195558, - "median": 0.7690245702483323, - "p90": 1.8136122342812846, - "p95": 1.9548737964733964, - "max": 4.332147922413344 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.04628122614893134, - "rotation_deg": 0.6982246240615032 - }, - { - "pair_index": 1, - "translation_m": 0.060020104078054665, - "rotation_deg": 0.3948778403656006 - }, - { - "pair_index": 2, - "translation_m": 0.10360591701372288, - "rotation_deg": 0.30363546700066535 - }, - { - "pair_index": 3, - "translation_m": 0.06188990107567784, - "rotation_deg": 0.5542261589736583 - }, - { - "pair_index": 4, - "translation_m": 0.02429424053491548, - "rotation_deg": 0.5086436052507228 - }, - { - "pair_index": 5, - "translation_m": 0.06697411809016678, - "rotation_deg": 0.7794510927257128 - }, - { - "pair_index": 6, - "translation_m": 0.012085958852730979, - "rotation_deg": 0.7997166092197476 - }, - { - "pair_index": 7, - "translation_m": 0.04528858471141819, - "rotation_deg": 0.868879957697597 - }, - { - "pair_index": 8, - "translation_m": 0.05426127100895971, - "rotation_deg": 1.8644817833901326 - }, - { - "pair_index": 9, - "translation_m": 0.12845158967421863, - "rotation_deg": 1.9850044675011511 - }, - { - "pair_index": 10, - "translation_m": 0.06743761428527982, - "rotation_deg": 0.23695300739340452 - }, - { - "pair_index": 11, - "translation_m": 0.060359774544132216, - "rotation_deg": 0.3380187067759931 - }, - { - "pair_index": 12, - "translation_m": 0.03420362550416907, - "rotation_deg": 0.49547670606543825 - }, - { - "pair_index": 13, - "translation_m": 0.059453942691852245, - "rotation_deg": 0.6142581264077737 - }, - { - "pair_index": 14, - "translation_m": 0.048234437308639966, - "rotation_deg": 1.7627426851724366 - }, - { - "pair_index": 15, - "translation_m": 0.0572558948305829, - "rotation_deg": 0.8826512445544471 - }, - { - "pair_index": 16, - "translation_m": 0.11847150615325375, - "rotation_deg": 4.332147922413344 - }, - { - "pair_index": 17, - "translation_m": 0.05084797298915324, - "rotation_deg": 0.9691629612561474 - }, - { - "pair_index": 18, - "translation_m": 0.03403536387594384, - "rotation_deg": 0.9311969881819248 - }, - { - "pair_index": 19, - "translation_m": 0.05397038183164141, - "rotation_deg": 0.5108403673418249 - }, - { - "pair_index": 20, - "translation_m": 0.10079710084559501, - "rotation_deg": 0.9132399116834199 - }, - { - "pair_index": 21, - "translation_m": 0.0245653967740859, - "rotation_deg": 0.29258746424545673 - }, - { - "pair_index": 22, - "translation_m": 0.06599237622687693, - "rotation_deg": 1.130391129168243 - }, - { - "pair_index": 23, - "translation_m": 0.30956690371502743, - "rotation_deg": 0.7585980477709516 - }, - { - "pair_index": 24, - "translation_m": 0.38818289084930874, - "rotation_deg": 0.6792102747820554 - }, - { - "pair_index": 25, - "translation_m": 0.10874622325422871, - "rotation_deg": 0.8215202229484776 - } - ] - } - }, - "ground": { - "planes": 34, - "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.00880269284499636, - 0.00901239388348182, - 0.0047231303576790815 - ], - "rotation_deg": [ - 0.08002846787949729, - 0.07607548557648909, - 0.16438009658312316 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 7.44293047593025, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 2.6261422580681395e-09, - "rotation_deg": 5.414246532613018e-08 - }, - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 1.4824807208067879e-09, - "rotation_deg": 1.72860210982948e-08 - }, - { - "cost": 125.63045335315223, - "success": true, - "translation_m": 2.630839730785566e-09, - "rotation_deg": 6.406686644059802e-08 - }, - { - "cost": 125.63045335315202, - "success": true, - "translation_m": 3.4171046507681323e-09, - "rotation_deg": 6.031782751294924e-08 - }, - { - "cost": 125.63045335315198, - "success": true, - "translation_m": 1.024465800095368e-09, - "rotation_deg": 5.593612335539163e-09 - }, - { - "cost": 125.63045335315205, - "success": true, - "translation_m": 3.3380353081804456e-09, - "rotation_deg": 5.989779005616406e-08 - }, - { - "cost": 125.63045335315195, - "success": true, - "translation_m": 1.3390324575379226e-09, - "rotation_deg": 1.669449907197552e-08 - }, - { - "cost": 125.63045335315194, - "success": true, - "translation_m": 9.664926809065912e-10, - "rotation_deg": 1.725605645088929e-08 - }, - { - "cost": 125.63045335315195, - "success": true, - "translation_m": 1.1236440604027455e-09, - "rotation_deg": 8.844155186013785e-09 - }, - { - "cost": 125.63045335315957, - "success": true, - "translation_m": 4.0330699471902714e-08, - "rotation_deg": 2.7706147186959257e-07 - }, - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 1.1516332665838399e-10, - "rotation_deg": 2.767718681568013e-09 - }, - { - "cost": 125.63045335315192, - "success": true, - "translation_m": 2.220446049250313e-16, - "rotation_deg": 0.0 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.004332764631777773, - 0.0052124106362270465, - 0.002294080818689292, - 0.09999053340933307, - 0.10013087210161215, - 0.1488688877903013 - ], - "p025": [ - 1.2918362278137754, - -0.009531330977586527, - 0.7011199682224338, - -0.9599898042168808, - 1.2066688822355272, - -1.2617485460367455 - ], - "p975": [ - 1.3082553293462966, - 0.009443875945124016, - 0.7092373306937458, - -0.5988363907444886, - 1.5590218787244785, - -0.7051603064062103 - ] - } -} \ No newline at end of file diff --git a/results/02_data4_calibration/final_extrinsic_data4.json b/results/02_data4_calibration/final_extrinsic_data4.json deleted file mode 100644 index 2bfd4ce..0000000 --- a/results/02_data4_calibration/final_extrinsic_data4.json +++ /dev/null @@ -1,334 +0,0 @@ -{ - "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.3003760202954853, - -0.001706690964618711, - 0.7048770452870675 - ], - "rotation_rpy_deg_xyz": [ - -0.7918916173570606, - 1.3938232102436765, - -0.9707426305626278 - ], - "quaternion_xyzw": [ - -0.006806709954738454, - 0.01222091143708808, - -0.008386347182892065, - 0.9998669847555559 - ], - "matrix_4x4": [ - [ - 0.9995606370091497, - 0.016604094942673456, - 0.024552738604839263, - 1.3003760202954853 - ], - [ - -0.016936831740812692, - 0.9997666757610401, - 0.01340663150469432, - -0.001706690964618711 - ], - [ - -0.02432440487342451, - -0.013816586729505535, - 0.9996086360464778, - 0.7048770452870675 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 34, - "pairs": 26, - "residuals": { - "pairs": 26, - "translation_m": { - "rms": 0.11761746401526753, - "median": 0.05973702338495346, - "p90": 0.12346154791373619, - "p95": 0.2642880752048252, - "max": 0.38818289084930874 - }, - "rotation_deg": { - "rms": 1.2425719632195558, - "median": 0.7690245702483323, - "p90": 1.8136122342812846, - "p95": 1.9548737964733964, - "max": 4.332147922413344 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.04628122614893134, - "rotation_deg": 0.6982246240615032 - }, - { - "pair_index": 1, - "translation_m": 0.060020104078054665, - "rotation_deg": 0.3948778403656006 - }, - { - "pair_index": 2, - "translation_m": 0.10360591701372288, - "rotation_deg": 0.30363546700066535 - }, - { - "pair_index": 3, - "translation_m": 0.06188990107567784, - "rotation_deg": 0.5542261589736583 - }, - { - "pair_index": 4, - "translation_m": 0.02429424053491548, - "rotation_deg": 0.5086436052507228 - }, - { - "pair_index": 5, - "translation_m": 0.06697411809016678, - "rotation_deg": 0.7794510927257128 - }, - { - "pair_index": 6, - "translation_m": 0.012085958852730979, - "rotation_deg": 0.7997166092197476 - }, - { - "pair_index": 7, - "translation_m": 0.04528858471141819, - "rotation_deg": 0.868879957697597 - }, - { - "pair_index": 8, - "translation_m": 0.05426127100895971, - "rotation_deg": 1.8644817833901326 - }, - { - "pair_index": 9, - "translation_m": 0.12845158967421863, - "rotation_deg": 1.9850044675011511 - }, - { - "pair_index": 10, - "translation_m": 0.06743761428527982, - "rotation_deg": 0.23695300739340452 - }, - { - "pair_index": 11, - "translation_m": 0.060359774544132216, - "rotation_deg": 0.3380187067759931 - }, - { - "pair_index": 12, - "translation_m": 0.03420362550416907, - "rotation_deg": 0.49547670606543825 - }, - { - "pair_index": 13, - "translation_m": 0.059453942691852245, - "rotation_deg": 0.6142581264077737 - }, - { - "pair_index": 14, - "translation_m": 0.048234437308639966, - "rotation_deg": 1.7627426851724366 - }, - { - "pair_index": 15, - "translation_m": 0.0572558948305829, - "rotation_deg": 0.8826512445544471 - }, - { - "pair_index": 16, - "translation_m": 0.11847150615325375, - "rotation_deg": 4.332147922413344 - }, - { - "pair_index": 17, - "translation_m": 0.05084797298915324, - "rotation_deg": 0.9691629612561474 - }, - { - "pair_index": 18, - "translation_m": 0.03403536387594384, - "rotation_deg": 0.9311969881819248 - }, - { - "pair_index": 19, - "translation_m": 0.05397038183164141, - "rotation_deg": 0.5108403673418249 - }, - { - "pair_index": 20, - "translation_m": 0.10079710084559501, - "rotation_deg": 0.9132399116834199 - }, - { - "pair_index": 21, - "translation_m": 0.0245653967740859, - "rotation_deg": 0.29258746424545673 - }, - { - "pair_index": 22, - "translation_m": 0.06599237622687693, - "rotation_deg": 1.130391129168243 - }, - { - "pair_index": 23, - "translation_m": 0.30956690371502743, - "rotation_deg": 0.7585980477709516 - }, - { - "pair_index": 24, - "translation_m": 0.38818289084930874, - "rotation_deg": 0.6792102747820554 - }, - { - "pair_index": 25, - "translation_m": 0.10874622325422871, - "rotation_deg": 0.8215202229484776 - } - ] - } - }, - "ground": { - "planes": 34, - "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.00880269284499636, - 0.00901239388348182, - 0.0047231303576790815 - ], - "rotation_deg": [ - 0.08002846787949729, - 0.07607548557648909, - 0.16438009658312316 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 7.44293047593025, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 2.6261422580681395e-09, - "rotation_deg": 5.414246532613018e-08 - }, - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 1.4824807208067879e-09, - "rotation_deg": 1.72860210982948e-08 - }, - { - "cost": 125.63045335315223, - "success": true, - "translation_m": 2.630839730785566e-09, - "rotation_deg": 6.406686644059802e-08 - }, - { - "cost": 125.63045335315202, - "success": true, - "translation_m": 3.4171046507681323e-09, - "rotation_deg": 6.031782751294924e-08 - }, - { - "cost": 125.63045335315198, - "success": true, - "translation_m": 1.024465800095368e-09, - "rotation_deg": 5.593612335539163e-09 - }, - { - "cost": 125.63045335315205, - "success": true, - "translation_m": 3.3380353081804456e-09, - "rotation_deg": 5.989779005616406e-08 - }, - { - "cost": 125.63045335315195, - "success": true, - "translation_m": 1.3390324575379226e-09, - "rotation_deg": 1.669449907197552e-08 - }, - { - "cost": 125.63045335315194, - "success": true, - "translation_m": 9.664926809065912e-10, - "rotation_deg": 1.725605645088929e-08 - }, - { - "cost": 125.63045335315195, - "success": true, - "translation_m": 1.1236440604027455e-09, - "rotation_deg": 8.844155186013785e-09 - }, - { - "cost": 125.63045335315957, - "success": true, - "translation_m": 4.0330699471902714e-08, - "rotation_deg": 2.7706147186959257e-07 - }, - { - "cost": 125.63045335315196, - "success": true, - "translation_m": 1.1516332665838399e-10, - "rotation_deg": 2.767718681568013e-09 - }, - { - "cost": 125.63045335315192, - "success": true, - "translation_m": 2.220446049250313e-16, - "rotation_deg": 0.0 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.004332764631777773, - 0.0052124106362270465, - 0.002294080818689292, - 0.09999053340933307, - 0.10013087210161215, - 0.1488688877903013 - ], - "p025": [ - 1.2918362278137754, - -0.009531330977586527, - 0.7011199682224338, - -0.9599898042168808, - 1.2066688822355272, - -1.2617485460367455 - ], - "p975": [ - 1.3082553293462966, - 0.009443875945124016, - 0.7092373306937458, - -0.5988363907444886, - 1.5590218787244785, - -0.7051603064062103 - ] - } -} \ No newline at end of file diff --git a/results/02_data4_calibration/open3d_gicp/B_estimation.npz b/results/02_data4_calibration/open3d_gicp/B_estimation.npz deleted file mode 100644 index 58cec4e..0000000 Binary files a/results/02_data4_calibration/open3d_gicp/B_estimation.npz and /dev/null differ diff --git a/results/02_data4_calibration/open3d_gicp/B_quality.csv b/results/02_data4_calibration/open3d_gicp/B_quality.csv deleted file mode 100644 index 96d43b5..0000000 --- a/results/02_data4_calibration/open3d_gicp/B_quality.csv +++ /dev/null @@ -1,97 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,1.8477087194158957,24.171297449440786,0.8061657032755298,0.10961296014103376,6,2.7038608113687213,0.004225163540003135,0.15304490677206398,1.0,True, -0,2,2.633731568575307,80.09074797031298,0.7489394523717702,0.116305716193008,6,3.0720058333957385,0.02073003109723772,0.12418344306820694,1.0,True, -0,3,6.923255970100826,79.91583883299243,0.6310283235519265,0.12470979645173065,6,5.235632990817995,0.02154775870989581,0.2539904497958252,1.0,True, -1,2,1.7155362084417105,55.91945052087219,0.7867383512544803,0.11079021393934936,6,3.282529873989152,0.0076823267394430066,0.05080433004685343,1.0,True, -1,3,5.885389341942907,55.74454138355163,0.6794562317367552,0.1190716913809658,6,4.183386002322129,0.024832426027852336,0.29364033194785566,1.0,True, -1,4,2.3031736807956613,106.08652205569953,0.6786112833230006,0.11255015823152649,6,3.2941312581877575,0.007769137931169012,0.07270245476793177,1.0,True, -2,3,4.339151683168145,0.17490913732054883,0.7586776859504132,0.11541610277862563,6,3.730803369806123,0.007879904085793275,0.11659483159946175,1.0,True, -2,4,0.6150408096900305,50.167071534827386,0.7854572527608884,0.1098649389241601,6,2.641287751481569,0.017042953274278242,0.09383247792992147,1.0,True, -2,5,5.894923525501676,8.735318060700383,0.7074574574574575,0.11912871456224478,6,3.8527093190832473,0.016641241123247028,0.24777402858141082,1.0,True, -3,4,3.9735035126146885,50.34198067214791,0.6974624291697462,0.1172763088894914,6,3.5010457716923225,0.012148721219467648,0.2079308684382429,1.0,True, -3,5,2.3619393178889707,8.910227198020932,0.7962985964476462,0.10646082199215777,6,3.0377458538379902,0.011008298723511818,0.08217077610411756,1.0,True, -3,6,2.2300116834828536,47.63555775102664,0.8376509054325956,0.10956583416752592,6,3.1930663579156233,0.001222821038316072,0.09207521511761255,1.0,True, -4,5,5.370771070097231,41.431753474126985,0.6652516676773802,0.12322094568314959,6,4.985227704290952,0.005399786589867114,0.1389350777589359,1.0,True, -4,6,6.142548765456278,97.97753842317456,0.6529585072428186,0.11878586101480827,6,5.324803753668097,0.011377811219747914,0.20418431358287809,1.0,True, -4,7,5.314106070657687,123.28910472998356,0.6964418087472202,0.11691192595448072,6,4.414726450762486,0.017641796253111963,0.10886712169052283,1.0,True, -5,6,1.9357867378988893,56.54578494904757,0.7526921648718901,0.10924852668609378,6,3.289802074469556,0.012374747586501101,0.14461856068326442,1.0,True, -5,7,0.19501559913675365,81.85735125585654,0.7833561729164071,0.11683079277948674,6,2.8807765869032655,0.0136898748124479,0.2000656277647698,1.0,True, -5,8,1.8038807059856978,172.47951556359365,0.7410703250525275,0.11436945722491815,6,3.9768956884456648,0.020336999081352437,0.07548452187379719,1.0,True, -6,7,2.130456053070114,25.311566306808988,0.8497729566094854,0.10415909908074772,6,3.375936129784756,0.008986805974948919,0.1309947950641294,1.0,True, -6,8,0.24494500622098103,115.93373061454483,0.7678928928928929,0.11166725079781287,6,3.2609205733873607,0.010085391730565987,0.11752836996157842,1.0,True, -6,9,8.025985916230132,103.90638727582186,0.6071384156199477,0.12594282886521954,6,6.882498483502561,0.01655440444551025,0.4345945520890901,1.0,True, -7,8,1.9962664218365056,90.62216430773583,0.8299748110831234,0.10748525688830209,6,3.0071179226782414,0.007106461978852689,0.10698728473689886,1.0,True, -7,9,7.8811064994361235,78.59482096901284,0.6188509200150206,0.1271320507839345,6,6.716979637303383,0.026230622734929154,0.28112746782878123,1.0,True, -7,10,7.620696678413973,134.60031955305035,0.5757088027733069,0.1313446077529101,6,5.755535843660075,0.012710332356906473,0.2297418063823675,1.0,True, -8,9,7.803713858547152,12.027343338722998,0.6326834719980131,0.12084265385763356,6,5.539689880493177,0.02518064403521875,0.3859647522318924,1.0,True, -8,10,8.062504137991457,43.97815524531457,0.6163861933423412,0.12936028463965984,6,4.789005902863088,0.011327540721525892,0.17059480981566058,1.0,True, -8,11,11.084531710563947,22.606708130954026,0.5371195721380364,0.13463285672049757,6,5.833003178860405,0.017887959781482814,0.14919899299178907,1.0,True, -9,10,2.04815062353057,56.00549858403758,0.6543345543345543,0.10729272360686735,6,3.3788563349731584,0.008725655639009402,0.02870462611907292,1.0,True, -9,11,4.738677237611319,34.634051469677026,0.5818780055682106,0.11717687815100752,6,3.555986532172074,0.009813025835682346,0.0603546019895227,1.0,True, -9,12,7.170741483679294,16.35622721712263,0.5379123584441162,0.12645695585785732,6,4.882558096197038,0.008862930161052695,0.11566409877698863,1.0,True, -10,11,3.2047552083250137,21.371447114360556,0.7118898623279099,0.1192865608074921,6,3.2202034715576238,0.0029529340190147615,0.0041769080934441144,1.0,True, -10,12,6.291813977735496,39.64927136691496,0.6120311738918656,0.1252565212812615,6,4.691686416856199,0.005686910809265337,0.10204044727301474,1.0,True, -10,13,10.199392557022867,72.41150002956134,0.516551290119572,0.1354903305714049,6,7.346543684414892,0.01356504272158301,0.3255230434099281,1.0,True, -11,12,3.467398797536633,18.277824252554396,0.650555275113579,0.12104882943540958,6,4.612247786063486,0.003583199374499245,0.03300207707174736,1.0,True, -11,13,7.516502113110916,51.04005291520078,0.5698054068172914,0.12858662743221627,6,7.539783468898054,0.016001435752891854,0.11059625579949509,1.0,True, -11,14,3.767517331528496,20.548768889074672,0.6420881321982974,0.12414062948335584,6,4.9522650472668115,0.012369101516230236,0.018705060406060074,1.0,True, -12,13,4.049286119591895,32.762228662646386,0.6972966112450819,0.11680896213116294,6,4.282247993741361,0.011410238767832601,0.04779713993430858,1.0,True, -12,14,0.97948616772873,2.2709446365202806,0.8749086479902558,0.09521299965540617,6,3.309695139564419,0.006159472215773642,0.014929948455572307,1.0,True, -12,15,4.286747470271891,25.863710300929224,0.7022030893897189,0.11797995277580095,6,4.2772327867721325,0.008495008365045943,0.102782991447036,1.0,True, -13,14,4.006260191078547,30.491284026126113,0.6955810147299509,0.1145595612270532,6,3.350289886810732,0.010228664633443074,0.03515966054944097,1.0,True, -13,15,0.9562774815922267,6.898518361717157,0.868300353819945,0.10454213568084784,6,3.243735713395398,0.0023750253827712867,0.010725047644197173,1.0,True, -13,16,3.565173336606111,18.944899794614482,0.7265456392027422,0.10962529664062398,6,3.522751424445623,0.008958927594995584,0.0304143851242741,1.0,True, -14,15,4.019575892829469,23.592765664408944,0.7120070334086913,0.11868441290330693,6,4.620592469502459,0.002571958018982041,0.05506919751152759,1.0,True, -14,16,7.5676649485439835,49.43618382074059,0.5918615984405458,0.12229328437386527,6,7.149509813179243,0.014273957859022303,0.25325650727956367,1.0,True, -14,17,5.910977627463022,0.8461207481731591,0.6694009445687298,0.12443900216431929,6,5.157741429696001,0.017895201000461415,0.10920228290609475,1.0,True, -15,16,3.7301261399251735,25.84341815633164,0.702887537993921,0.11495230769293868,6,3.540289976352534,0.013545291843393993,0.033466251783377816,1.0,True, -15,17,2.2049738368271745,24.438886412582093,0.7429531936901991,0.11679524427533879,6,3.526664394280145,0.00989411002791081,0.07786907370564648,1.0,True, -15,18,4.7000039832559155,3.452521908779401,0.7209645010046886,0.11716134583909153,6,4.125231895423432,0.011654729311847106,0.13683586564190353,1.0,True, -16,17,3.368526196086246,50.282304568913744,0.618922305764411,0.11254196340939995,6,4.068632188828396,0.03104786021350874,0.10375098145235381,1.0,True, -16,18,3.5240348999326185,22.39089624755224,0.6890156918687589,0.11084024896736888,6,4.42116710884217,0.01556225520371614,0.02495881796886513,1.0,True, -16,19,2.146829294717985,30.035090485266103,0.8685060899826,0.10135543575024519,6,2.92007223300188,0.002952251383831446,0.02753369989560042,1.0,True, -17,18,2.640403049812329,27.891408321361506,0.7697708305735859,0.10648049893472207,6,3.7928223564531667,0.010582276181446382,0.039599051949106026,1.0,True, -17,19,3.933985934417215,80.31739505417984,0.6293759512937596,0.1095449771750205,6,3.6483069293931876,0.012240937390583118,0.060306184678878015,1.0,True, -17,20,4.2254212089887,152.98392843416656,0.6014520938674964,0.12300562605352797,6,4.719447385686107,1.3272837904090529,0.4474442011368189,1.0,False,forward_reverse_translation -18,19,2.4460967931915643,52.425986732818345,0.6827314510833881,0.10834806615100012,6,3.5073857685652805,0.012418496053917759,0.11905018881098527,1.0,True, -18,20,6.593931011285688,125.09252011280485,0.5756313809779688,0.1265759478434112,6,5.389095141151797,0.012917057356045326,0.24042373011343365,1.0,True, -18,21,11.793089868757727,175.70238585456048,0.4044519656339495,0.14396876383759685,6,10.041635341774429,0.06610149517267662,0.6118050873537593,1.0,False,forward_reverse_rotation -19,20,6.650720121741557,72.6665333799865,0.6234734541714874,0.12775305804057488,6,5.958603794025073,0.009237066767190358,0.22540488888099894,1.0,True, -19,21,12.053580264031138,123.27639912174077,0.3788200074840963,0.14687803396129923,6,10.170069582593054,0.1645149893124099,1.1204113986936788,1.0,False,forward_reverse_translation;forward_reverse_rotation -19,22,14.836246959975925,128.85294276465592,0.3215252152521525,0.1505833656059155,6,15.25410245430046,0.08605091089946505,0.48945936193054473,1.0,False,heldout_inlier_ratio;forward_reverse_translation -20,21,5.40286046809103,50.60986574175429,0.6596992097884272,0.12147955429086157,6,4.0820327359553845,0.014725537493637062,0.1988422472286775,1.0,True, -20,22,8.200956565000565,56.18640938466938,0.5739414499308958,0.13255415786946786,6,5.328486341352201,0.006040617548520927,0.19706632354687328,1.0,True, -20,23,5.175118275082073,70.79178325235415,0.6456945156330087,0.12075756038041646,6,3.9642702950866386,0.022949011013485506,0.1911210947924365,1.0,True, -21,22,2.8644847627909416,5.57654364291509,0.7716237647919971,0.11632271358541554,6,2.79620153032919,0.00996357879827298,0.15332892195322273,1.0,True, -21,23,1.2936223973175418,20.18191751059984,0.8576224819696593,0.09865676260631216,6,3.0367950693845156,0.0039225733250952055,0.00898487649368532,1.0,True, -21,24,2.3128500583741403,54.59467208208593,0.7715940569126165,0.1136150455355286,6,2.76815824933335,0.007475673605589086,0.042277690012993266,1.0,True, -22,23,3.7194009250537223,14.605373867684753,0.7396689147762109,0.11702962848624102,6,3.4148047250889095,0.01814015943430581,0.11847321816106485,1.0,True, -22,24,4.786117710081478,49.01812843917083,0.6983240223463687,0.11898873157361621,6,3.6334655936865663,0.013438931050857202,0.08244161259412694,1.0,True, -22,25,2.3747421598149763,12.391903814042255,0.736861094407697,0.11586394710110075,6,2.383007054117407,0.018559552524775386,0.0645260279790244,1.0,True, -23,24,1.0880644725336985,34.41275457148609,0.7853164556962026,0.1128725442321241,6,2.409921828847164,0.002195759849115173,0.032112959181416705,1.0,True, -23,25,5.033935954106079,2.213470053642494,0.6881127450980392,0.12303206700403986,6,2.9363727218037994,0.004939188019100004,0.12964064637100806,1.0,True, -23,26,5.765534437288107,40.730927532824346,0.6852618757612667,0.12040544972155913,6,3.0590065093977192,0.006032445250250899,0.14039335223024835,1.0,True, -24,25,6.097212810998921,36.62622462512857,0.677667493796526,0.12346315805814134,6,3.6286524357748307,0.02347922689116974,0.16273859629352566,1.0,True, -24,26,6.852918693116795,6.318172961338249,0.6530209617755857,0.12710147612984257,6,3.5331859775372005,0.013311199903818141,0.18193579850152686,1.0,True, -24,27,7.47982907414204,31.60254826458195,0.6649014778325123,0.1248115961442785,6,4.10006355979974,0.017872821205486625,0.1680556511699705,1.0,True, -25,26,1.2882746074869595,42.944397586466835,0.9127837514934289,0.0958142916589384,6,2.9017658682436953,0.003534148840172682,0.018440169300173608,1.0,True, -25,27,1.7666235781584831,68.22877288971053,0.8510739856801909,0.10418150333394147,6,2.368253417089997,0.006103232696002816,0.13366555345652814,1.0,True, -25,28,2.1807182972588706,88.09106909546726,0.8853518429870751,0.10761251229652005,6,2.6372860976794645,0.003483231665912094,0.0369774420199415,1.0,True, -26,27,0.6269948654714946,25.284375303243706,0.9183867141162515,0.09074909570650921,6,2.8142315359282506,0.00040199505815422204,0.011554314408129918,1.0,True, -26,28,0.9431372257108486,45.14667150900044,0.8853200095170116,0.10604184939655073,6,2.656402027789519,0.007320240476189879,0.12930335868605478,1.0,True, -26,29,1.129925637779203,87.41573662125148,0.7880466815984911,0.10871274240898265,6,3.111957466886604,0.0063952430610542755,0.039517035902874385,1.0,True, -27,28,0.44809323479571145,19.862296205756735,0.9289448669201521,0.0850509551532673,6,2.96325286846982,0.005157655135591474,0.022666807877311387,1.0,True, -27,29,1.160064136065596,62.13136131800778,0.7872365477452019,0.10455513464835667,6,2.9621627623005296,0.011650639607012138,0.1624719134077532,1.0,True, -27,30,4.25412615059095,152.09392556214777,0.04792444029850746,0.15706827084964883,6,3.4115087753552786,2.5641513880069633,2.874944882076104,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -28,29,1.5995723610319212,42.26906511225104,0.8000944621560987,0.1086547547358129,6,3.1466224100058553,0.0011394164967304414,0.02119627748719656,1.0,True, -28,30,4.295353381127667,132.23162935639104,0.042095416276894296,0.16025490727880456,6,4.631028587407634,2.5607552487652696,2.17230408479254,0.0,False,heldout_inlier_ratio;heldout_inlier_rmse;forward_reverse_translation;forward_reverse_rotation;multistart_instability -28,31,5.754426930327516,158.8421298011293,0.7465330381074466,0.1066966653439246,6,2.402598366822474,0.00635764905956918,0.040016615214377715,1.0,True, -29,30,4.099530130205247,89.96256424413995,0.7248812145092132,0.10870831469083347,6,2.9471223804737057,0.00465638537716095,0.12465763189227934,1.0,True, -29,31,4.890018768530818,116.57306468887772,0.7243012243012243,0.11138751941762699,6,2.7645021322697017,0.004263906321896464,0.046637396086304225,1.0,True, -29,32,4.464737187763289,159.39493219688632,0.6956070563818748,0.1103354081949904,6,3.227012588611917,0.011088061861347823,0.34561739459504637,1.0,True, -30,31,2.3862917603439455,26.61050044473775,0.8185562292643862,0.0961579573295129,6,2.899558208444643,0.004999163455591531,0.0213847958734735,1.0,True, -30,32,1.1507634071714652,69.43236795274659,0.8041343079031521,0.099533431536842,6,2.6146168742247573,0.003171376495143,0.02376737774843464,1.0,True, -30,33,2.4361832484951105,160.7145717128102,0.0824534345711235,0.13003518012314966,6,7.2913036106936,1.3743823383381788,1.9837113244583153,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -31,32,1.2514382602180638,42.82186750800885,0.8157085941946499,0.09925944770258267,6,3.0485411400768245,0.004719596234887584,0.06146741991681224,1.0,True, -31,33,0.641507519046697,134.10407126807203,0.0911563017261764,0.12702324561674966,6,7.541483837366941,2.816294381538612,3.333105317420589,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -32,33,1.4370687242949811,91.2822037600631,0.7569928006609229,0.10008740880870744,6,3.6611044282667207,2.988193350509204,2.696443494598379,1.0,False,forward_reverse_translation;forward_reverse_rotation diff --git a/results/02_data4_calibration/open3d_gicp/B_quality.json b/results/02_data4_calibration/open3d_gicp/B_quality.json deleted file mode 100644 index 8a1a178..0000000 --- a/results/02_data4_calibration/open3d_gicp/B_quality.json +++ /dev/null @@ -1,12004 +0,0 @@ -{ - "schema_version": 2, - "backend": "open3d", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 34, - "candidate_pairs": 96, - "accepted_pairs": 87, - "parameters": { - "command": "pairs", - "backend": "open3d", - "frames": "\\data4_prepared\\frames_all", - "body": "\\data4_prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "results\\02_data4_calibration\\open3d_gicp\\B_estimation.npz", - "quality_json": "results\\02_data4_calibration\\open3d_gicp\\B_quality.json", - "quality_csv": "results\\02_data4_calibration\\open3d_gicp\\B_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 20, - "min_gap": 1, - "max_gap": 3, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 40, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 1, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 80, - "translation_rms_m": 0.018166280559552293, - "translation_p95_m": 0.032032870276120416, - "rotation_rms_deg": 0.2258764385588969, - "rotation_p95_deg": 0.4138842730797386 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784783905.353819, - "frame_counter_i": 382, - "frame_counter_j": 1182, - "rtk_translation_m": 1.8477087194158957, - "rtk_rotation_deg": 24.171297449440786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9124833454993864, - 0.4087832678693191, - 0.016443360250509458, - 1.607248674769736 - ], - [ - -0.4087570975022782, - 0.9126290990659016, - -0.005075704845147599, - -1.2736994951406013 - ], - [ - -0.017081552264378075, - -0.002089844071314855, - 0.9998519155975032, - 0.015083257286964366 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8912, - "backend_objective": 121.7846872438052, - "backend_elapsed_sec": 0.6735248000186402, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9747102212855637, - "inlier_rmse_m": 0.29732734644907166, - "target_points": 4680, - "source_points": 4745 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9067073170731708, - "inlier_rmse_m": 0.17788239925150534, - "target_points": 8116, - "source_points": 8200 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7850599013389711, - "inlier_rmse_m": 0.11689845025056375, - "target_points": 11527, - "source_points": 11352 - } - ], - "heldout_symmetric": { - "evaluated": 7785, - "inliers": 6276, - "inlier_ratio": 0.8061657032755298, - "inlier_rmse_m": 0.10961296014103376, - "median_m": 0.10290553406024071, - "p90_m": 0.4159689941694349, - "p95_m": 0.660543787598926 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4570.928424341017, - 6091.915500186119, - 8218.29586154031, - 8912.000000000004, - 9908.615279058009, - 12359.154238147052 - ], - "effective_rank": 6, - "scaled_condition_number": 2.7038608113687213, - "weakest_scaled_direction": [ - 0.1404548149582046, - -0.954489788282662, - -0.022808000846886767, - 0.15027831562051963, - 0.02720394885209864, - -0.2130207903882992 - ] - }, - "forward_reverse": { - "translation_m": 0.004225163540003135, - "rotation_deg": 0.15304490677206398 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.88711357575485e-15, - "rotation_deg": 3.644959732437771e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784783971.0503054, - "frame_counter_i": 382, - "frame_counter_j": 1839, - "rtk_translation_m": 2.633731568575307, - "rtk_rotation_deg": 80.09074797031298, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.18415074469542553, - 0.9828874303255367, - -0.004560979739464177, - 0.1285797386588232 - ], - [ - -0.9822201459742468, - 0.18384945289183605, - -0.037986359574273536, - -3.6632910616894554 - ], - [ - -0.036497781719628336, - 0.01147510258935272, - 0.9992678489524749, - -0.05090295442714565 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8376, - "backend_objective": 121.70157639854357, - "backend_elapsed_sec": 1.1375933999952395, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9193615257048093, - "inlier_rmse_m": 0.36012160429722173, - "target_points": 4680, - "source_points": 4824 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8147617341454676, - "inlier_rmse_m": 0.18234917834663997, - "target_points": 8116, - "source_points": 8373 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7151028771450525, - "inlier_rmse_m": 0.1205396059773973, - "target_points": 11527, - "source_points": 11713 - } - ], - "heldout_symmetric": { - "evaluated": 7779, - "inliers": 5826, - "inlier_ratio": 0.7489394523717702, - "inlier_rmse_m": 0.116305716193008, - "median_m": 0.12166881280745838, - "p90_m": 0.7253251436615892, - "p95_m": 1.1864732045548871 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4510.301945304857, - 5697.075682531042, - 7337.131383859359, - 8376.000000000002, - 10950.97395174291, - 13855.673886352668 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0720058333957385, - "weakest_scaled_direction": [ - 0.17845194667543746, - -0.9529192811024751, - -0.06046276323885731, - 0.21322516669365418, - 0.04590670542155498, - -0.09418918928525147 - ] - }, - "forward_reverse": { - "translation_m": 0.02073003109723772, - "rotation_deg": 0.12418344306820694 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.3255766586637668e-15, - "rotation_deg": 3.9062251487094956e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 382, - "frame_counter_j": 2726, - "rtk_translation_m": 6.923255970100826, - "rtk_rotation_deg": 79.91583883299243, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.18112144418244783, - 0.9834422822049228, - -0.006024950525822739, - 1.0114106687503623 - ], - [ - -0.9828026468188434, - 0.18077276862125635, - -0.03768505712988331, - -7.9180064229089 - ], - [ - -0.035971931601476256, - 0.012746909295193681, - 0.9992715028661021, - -0.09176761115724737 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7222, - "backend_objective": 119.47233078198428, - "backend_elapsed_sec": 0.7550125000125263, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8704347826086957, - "inlier_rmse_m": 0.4030752687532109, - "target_points": 4680, - "source_points": 4600 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7492377119160873, - "inlier_rmse_m": 0.2074968430810786, - "target_points": 8116, - "source_points": 8199 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6172122040851209, - "inlier_rmse_m": 0.12861894002776791, - "target_points": 11527, - "source_points": 11701 - } - ], - "heldout_symmetric": { - "evaluated": 7838, - "inliers": 4946, - "inlier_ratio": 0.6310283235519265, - "inlier_rmse_m": 0.12470979645173065, - "median_m": 0.16249583491150005, - "p90_m": 1.127892426892725, - "p95_m": 1.6840798396493042 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3116.530870928646, - 3616.077459867839, - 4530.932260100788, - 7221.999999999998, - 14064.642102863943, - 16317.011844736757 - ], - "effective_rank": 6, - "scaled_condition_number": 5.235632990817995, - "weakest_scaled_direction": [ - -0.0889517997231584, - -0.8727994203652213, - -0.07100183172264181, - 0.20279792874891328, - 0.014220955059010583, - -0.42888023218672017 - ] - }, - "forward_reverse": { - "translation_m": 0.02154775870989581, - "rotation_deg": 0.2539904497958252 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.561946379312358e-15, - "rotation_deg": 4.082099171790095e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784783971.0503054, - "frame_counter_i": 1182, - "frame_counter_j": 1839, - "rtk_translation_m": 1.7155362084417105, - "rtk_rotation_deg": 55.91945052087219, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5703621590849038, - 0.821348578612324, - -0.008574374351692447, - -0.37061613600444165 - ], - [ - -0.821058167224997, - 0.5698001829877843, - -0.034514308630153326, - -2.7849967100804527 - ], - [ - -0.023462598260563367, - 0.026725715679918577, - 0.9993674212241758, - -0.06696246882094566 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8688, - "backend_objective": 119.12615101554276, - "backend_elapsed_sec": 0.671062899986282, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.929726368159204, - "inlier_rmse_m": 0.33697921087708393, - "target_points": 4745, - "source_points": 4824 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8418726860145707, - "inlier_rmse_m": 0.18138320701055788, - "target_points": 8200, - "source_points": 8373 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.741739947067361, - "inlier_rmse_m": 0.11709642843192421, - "target_points": 11352, - "source_points": 11713 - } - ], - "heldout_symmetric": { - "evaluated": 7812, - "inliers": 6146, - "inlier_ratio": 0.7867383512544803, - "inlier_rmse_m": 0.11079021393934936, - "median_m": 0.10615299310778248, - "p90_m": 0.555946571740533, - "p95_m": 0.969515419595336 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4247.758040296146, - 6590.793258482112, - 7765.743344720985, - 8688.0, - 10671.432788876968, - 13943.392664749714 - ], - "effective_rank": 6, - "scaled_condition_number": 3.282529873989152, - "weakest_scaled_direction": [ - 0.7143715770369833, - -0.5685039425704193, - -0.01437367248859399, - 0.09525659775198415, - 0.11006738261592135, - 0.3808953486347275 - ] - }, - "forward_reverse": { - "translation_m": 0.0076823267394430066, - "rotation_deg": 0.05080433004685343 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.091906389296114e-15, - "rotation_deg": 1.2370917720180042e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 1182, - "frame_counter_j": 2726, - "rtk_translation_m": 5.885389341942907, - "rtk_rotation_deg": 55.74454138355163, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5677117937717027, - 0.8231722635499711, - -0.009525950584280525, - 2.1747982089262523 - ], - [ - -0.8228726633723463, - 0.567089527482333, - -0.03591723394647397, - -6.307683293538051 - ], - [ - -0.024164003952513127, - 0.0282292816395109, - 0.9993093657977496, - -0.055834217336639576 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7559, - "backend_objective": 116.91522311551721, - "backend_elapsed_sec": 0.6891992000164464, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.89, - "inlier_rmse_m": 0.3986148224803752, - "target_points": 4745, - "source_points": 4600 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7724112696670326, - "inlier_rmse_m": 0.201735357046292, - "target_points": 8200, - "source_points": 8199 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6460131612682677, - "inlier_rmse_m": 0.12436648465333977, - "target_points": 11352, - "source_points": 11701 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 5348, - "inlier_ratio": 0.6794562317367552, - "inlier_rmse_m": 0.1190716913809658, - "median_m": 0.14051140425269928, - "p90_m": 0.9280799954286513, - "p95_m": 1.4150638702240643 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3358.8141228463414, - 3883.3604923113085, - 5142.063251551352, - 7559.0, - 11941.83472714739, - 14051.215985917264 - ], - "effective_rank": 6, - "scaled_condition_number": 4.183386002322129, - "weakest_scaled_direction": [ - 0.6588843053936845, - -0.6731253792992864, - -0.06228269912551105, - 0.1403779452877159, - 0.11178388486547487, - 0.27693493242979667 - ] - }, - "forward_reverse": { - "translation_m": 0.024832426027852336, - "rotation_deg": 0.29364033194785566 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.810912295584256e-15, - "rotation_deg": 2.918755522343551e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 1182, - "frame_counter_j": 3621, - "rtk_translation_m": 2.3031736807956613, - "rtk_rotation_deg": 106.08652205569953, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.2792586016320975, - 0.9595668478601869, - -0.035300111928288046, - -1.6343974322405281 - ], - [ - -0.9583479302727091, - -0.28081892958279203, - -0.05205740418028683, - -3.5931015258593946 - ], - [ - -0.059865498882916174, - 0.019292311308886003, - 0.9980200041922311, - -0.13672808218991864 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7720, - "backend_objective": 110.04688896458612, - "backend_elapsed_sec": 0.7995364000089467, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8763514841753489, - "inlier_rmse_m": 0.4049968642637917, - "target_points": 4745, - "source_points": 5087 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7437456160860416, - "inlier_rmse_m": 0.19028982821036353, - "target_points": 8200, - "source_points": 8554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6436015006252606, - "inlier_rmse_m": 0.1193933765469775, - "target_points": 11352, - "source_points": 11995 - } - ], - "heldout_symmetric": { - "evaluated": 8065, - "inliers": 5473, - "inlier_ratio": 0.6786112833230006, - "inlier_rmse_m": 0.11255015823152649, - "median_m": 0.13047764634417147, - "p90_m": 1.0497407641801448, - "p95_m": 1.563911048890568 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3967.7384126797183, - 6296.931320752373, - 7292.601523964159, - 7719.999999999999, - 9605.642013811417, - 13070.251129520537 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2941312581877575, - "weakest_scaled_direction": [ - 0.629765991931893, - -0.6489876134085772, - -0.022216375998354243, - 0.12351099951532632, - 0.10636918945679678, - 0.3938869561419962 - ] - }, - "forward_reverse": { - "translation_m": 0.007769137931169012, - "rotation_deg": 0.07270245476793177 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.450677444825646e-15, - "rotation_deg": 2.7205656615342872e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 1839, - "frame_counter_j": 2726, - "rtk_translation_m": 4.339151683168145, - "rtk_rotation_deg": 0.17490913732054883, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.999991319380825, - 0.003378147225644592, - 0.0024391154786888402, - 4.343951852265247 - ], - [ - -0.003378296881480377, - 0.999994291900637, - 5.7239162451469864e-05, - 0.08240890312795224 - ], - [ - -0.0024389081936575054, - -6.547872179532494e-05, - 0.9999970237152489, - 0.09238422580396248 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8533, - "backend_objective": 124.04338155685502, - "backend_elapsed_sec": 0.8489924999885261, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9547826086956521, - "inlier_rmse_m": 0.34565071620542903, - "target_points": 4824, - "source_points": 4600 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8579095011586779, - "inlier_rmse_m": 0.1910296234806383, - "target_points": 8373, - "source_points": 8199 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7292539099222288, - "inlier_rmse_m": 0.12056907407753296, - "target_points": 11713, - "source_points": 11701 - } - ], - "heldout_symmetric": { - "evaluated": 7865, - "inliers": 5967, - "inlier_ratio": 0.7586776859504132, - "inlier_rmse_m": 0.11541610277862563, - "median_m": 0.11579828430632305, - "p90_m": 0.5963558285722059, - "p95_m": 0.9938464692460102 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3882.109898512825, - 5437.98649130646, - 6774.243136412574, - 8532.999999999998, - 11927.346365475993, - 14483.388691329354 - ], - "effective_rank": 6, - "scaled_condition_number": 3.730803369806123, - "weakest_scaled_direction": [ - 0.9256360542292418, - -0.19327966065111107, - -0.028638752245179484, - 0.024698876028721752, - 0.15989145149735912, - -0.28079419335224304 - ] - }, - "forward_reverse": { - "translation_m": 0.007879904085793275, - "rotation_deg": 0.11659483159946175 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1597090274781069e-14, - "rotation_deg": 2.2636696567291275e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 1839, - "frame_counter_j": 3621, - "rtk_translation_m": 0.6150408096900305, - "rtk_rotation_deg": 50.167071534827386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6292283506890186, - 0.7772079210651236, - -0.004419289853054612, - -0.06037445948293375 - ], - [ - -0.7769405172797831, - 0.6288389197498825, - -0.030414562578222216, - -1.5018669787964878 - ], - [ - -0.02085941749426873, - 0.022571230392464278, - 0.9995276005495645, - -0.016724501583587736 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8927, - "backend_objective": 118.19685080134848, - "backend_elapsed_sec": 0.6347673000127543, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.957145665421663, - "inlier_rmse_m": 0.3166949336818787, - "target_points": 4824, - "source_points": 5087 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8731587561374795, - "inlier_rmse_m": 0.18589209082209873, - "target_points": 8373, - "source_points": 8554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7442267611504794, - "inlier_rmse_m": 0.11506683968984271, - "target_points": 11713, - "source_points": 11995 - } - ], - "heldout_symmetric": { - "evaluated": 8059, - "inliers": 6330, - "inlier_ratio": 0.7854572527608884, - "inlier_rmse_m": 0.1098649389241601, - "median_m": 0.1080405056113027, - "p90_m": 0.4846096342206315, - "p95_m": 0.7508272406722126 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4973.178708122637, - 7635.867578439772, - 8927.0, - 9133.365101136127, - 9441.611777821116, - 13135.596007693253 - ], - "effective_rank": 6, - "scaled_condition_number": 2.641287751481569, - "weakest_scaled_direction": [ - 0.9581967989778387, - 0.16346925646298, - 0.00329099831049311, - -0.03407435681613071, - 0.1972613613793352, - 0.12268968768614129 - ] - }, - "forward_reverse": { - "translation_m": 0.017042953274278242, - "rotation_deg": 0.09383247792992147 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5142854222490728e-15, - "rotation_deg": 1.239157671383907e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 1839, - "frame_counter_j": 4371, - "rtk_translation_m": 5.894923525501676, - "rtk_rotation_deg": 8.735318060700383, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9888798584604905, - 0.14861505655550875, - 0.005494587897629577, - 5.573060338161258 - ], - [ - -0.14860716924014655, - 0.9888946353451434, - -0.0018191855392335858, - -2.128175157319343 - ], - [ - -0.005703926857196394, - 0.0009824207849427802, - 0.9999832498936211, - 0.09435783689948411 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8063, - "backend_objective": 121.26392622624698, - "backend_elapsed_sec": 1.204426499985857, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9105217766278568, - "inlier_rmse_m": 0.37941227871451855, - "target_points": 4824, - "source_points": 4638 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8008349705304518, - "inlier_rmse_m": 0.19790572332369388, - "target_points": 8373, - "source_points": 8144 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6792182629938506, - "inlier_rmse_m": 0.12263586053133406, - "target_points": 11713, - "source_points": 11871 - } - ], - "heldout_symmetric": { - "evaluated": 7992, - "inliers": 5654, - "inlier_ratio": 0.7074574574574575, - "inlier_rmse_m": 0.11912871456224478, - "median_m": 0.13161180955394386, - "p90_m": 0.763536316327384, - "p95_m": 1.2796367011309606 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3768.856744238671, - 4907.756093047072, - 6205.779531004399, - 8062.999999999997, - 11997.693692097588, - 14520.309500818075 - ], - "effective_rank": 6, - "scaled_condition_number": 3.8527093190832473, - "weakest_scaled_direction": [ - 0.8516205342757313, - -0.36459246206899604, - -0.05202383078592718, - 0.06243044948132635, - 0.19068815377050627, - -0.31440227451769237 - ] - }, - "forward_reverse": { - "translation_m": 0.016641241123247028, - "rotation_deg": 0.24777402858141082 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.700600662293866e-15, - "rotation_deg": 2.2287436183320685e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 2726, - "frame_counter_j": 3621, - "rtk_translation_m": 3.9735035126146885, - "rtk_rotation_deg": 50.34198067214791, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6320383959302255, - 0.7749216717289151, - -0.004885565966439111, - -4.397133705168794 - ], - [ - -0.7746603786543729, - 0.6316317106519097, - -0.030703091733681923, - -1.5995131761862942 - ], - [ - -0.020706612784626342, - 0.023190187230957525, - 0.9995166088680972, - -0.13124589981666174 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7775, - "backend_objective": 118.77394537513572, - "backend_elapsed_sec": 0.6677896000037435, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9156673874582268, - "inlier_rmse_m": 0.394140946532546, - "target_points": 4600, - "source_points": 5087 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7739069441197101, - "inlier_rmse_m": 0.19540520828645833, - "target_points": 8199, - "source_points": 8554 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6481867444768653, - "inlier_rmse_m": 0.1235977009823417, - "target_points": 11701, - "source_points": 11995 - } - ], - "heldout_symmetric": { - "evaluated": 8118, - "inliers": 5662, - "inlier_ratio": 0.6974624291697462, - "inlier_rmse_m": 0.1172763088894914, - "median_m": 0.13132035817090315, - "p90_m": 0.8644149430219845, - "p95_m": 1.3312626239168603 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4054.536206922804, - 5223.36917965103, - 6473.618437295361, - 7775.000000000002, - 11364.074032659659, - 14195.11684342051 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5010457716923225, - "weakest_scaled_direction": [ - 0.9522800830762025, - 0.11220892226905158, - 0.05058803004350543, - -0.014116003231909953, - 0.20505814044941273, - -0.18911517613375647 - ] - }, - "forward_reverse": { - "translation_m": 0.012148721219467648, - "rotation_deg": 0.2079308684382429 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2525283383123117e-15, - "rotation_deg": 2.1518695944473066e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 2726, - "frame_counter_j": 4371, - "rtk_translation_m": 2.3619393178889707, - "rtk_rotation_deg": 8.910227198020932, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9893836285143895, - 0.14532171070747418, - 0.0012790718334064976, - 1.2442614991982979 - ], - [ - -0.14531728735485663, - 0.9893803920362936, - -0.0030538254594377973, - -2.2077202594323104 - ], - [ - -0.0017092757319458404, - 0.0028355336647455554, - 0.999994519047634, - -0.0048488466134743715 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9071, - "backend_objective": 113.474000993497, - "backend_elapsed_sec": 0.6919846999808215, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9510564898663217, - "inlier_rmse_m": 0.32654207140609, - "target_points": 4600, - "source_points": 4638 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8629666011787819, - "inlier_rmse_m": 0.17746795053925932, - "target_points": 8199, - "source_points": 8144 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7641310757307724, - "inlier_rmse_m": 0.11184603700225404, - "target_points": 11701, - "source_points": 11871 - } - ], - "heldout_symmetric": { - "evaluated": 8051, - "inliers": 6411, - "inlier_ratio": 0.7962985964476462, - "inlier_rmse_m": 0.10646082199215777, - "median_m": 0.09596000236923331, - "p90_m": 0.484811204037213, - "p95_m": 0.7011085403614495 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4435.760688008934, - 7122.86936683215, - 8604.129119207291, - 9070.999999999996, - 10589.288926429066, - 13474.713638616691 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0377458538379902, - "weakest_scaled_direction": [ - 0.9608319986059689, - -0.220986705578402, - -0.00198817640466025, - 0.03515283523472079, - 0.15230712743517377, - 0.059410526629998246 - ] - }, - "forward_reverse": { - "translation_m": 0.011008298723511818, - "rotation_deg": 0.08217077610411756 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8972738541948013e-15, - "rotation_deg": 1.0226161295408938e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 2726, - "frame_counter_j": 5145, - "rtk_translation_m": 2.2300116834828536, - "rtk_rotation_deg": 47.63555775102664, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6772870061114546, - -0.735249933447995, - -0.02626493322478562, - 1.7740013973911537 - ], - [ - 0.7357019435089199, - 0.677082102958797, - 0.017391842055759523, - 0.6213249385951899 - ], - [ - 0.004996165507874993, - -0.031102431056315417, - 0.9995037154071034, - 0.04083951617812816 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9539, - "backend_objective": 132.3713911436418, - "backend_elapsed_sec": 0.593184299999848, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9644626319190178, - "inlier_rmse_m": 0.28650239278823486, - "target_points": 4600, - "source_points": 4643 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9216512215669755, - "inlier_rmse_m": 0.17307630871826551, - "target_points": 8199, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8227531481800932, - "inlier_rmse_m": 0.1178000953923029, - "target_points": 11701, - "source_points": 11594 - } - ], - "heldout_symmetric": { - "evaluated": 7952, - "inliers": 6661, - "inlier_ratio": 0.8376509054325956, - "inlier_rmse_m": 0.10956583416752592, - "median_m": 0.09286190805204038, - "p90_m": 0.3519457305672478, - "p95_m": 0.6303741784816209 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4335.048621956588, - 8157.510996847705, - 9347.496641886986, - 9539.000000000005, - 10640.892047285995, - 13842.097914698064 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1930663579156233, - "weakest_scaled_direction": [ - 0.964193694735429, - -0.1775620596190689, - 0.00907211392937754, - 0.026007140684818703, - 0.133981117015575, - -0.14174843802239048 - ] - }, - "forward_reverse": { - "translation_m": 0.001222821038316072, - "rotation_deg": 0.09207521511761255 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.107791749636883e-15, - "rotation_deg": 1.3643868417777186e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 3621, - "frame_counter_j": 4371, - "rtk_translation_m": 5.370771070097231, - "rtk_rotation_deg": 41.431753474126985, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7377607241755659, - -0.6748834541629345, - -0.015538248326307019, - 4.039303684210858 - ], - [ - 0.6750461938138492, - 0.7373886445502595, - 0.02388771872264557, - 3.9981006302936284 - ], - [ - -0.0046636982515908055, - -0.028112456054929163, - 0.9995938874028709, - 0.11263299493156713 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7809, - "backend_objective": 127.01001991640706, - "backend_elapsed_sec": 1.4423731999995653, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9085812850366537, - "inlier_rmse_m": 0.3961198724715249, - "target_points": 5087, - "source_points": 4638 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7766453831041258, - "inlier_rmse_m": 0.19814918375497936, - "target_points": 8554, - "source_points": 8144 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6578215820065706, - "inlier_rmse_m": 0.12753261965570323, - "target_points": 11995, - "source_points": 11871 - } - ], - "heldout_symmetric": { - "evaluated": 8245, - "inliers": 5485, - "inlier_ratio": 0.6652516676773802, - "inlier_rmse_m": 0.12322094568314959, - "median_m": 0.14648034241398247, - "p90_m": 0.975147506162722, - "p95_m": 1.5172482580253346 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3103.694574452784, - 5046.986546739481, - 5811.580279862563, - 7809.000000000002, - 12601.040904103416, - 15472.624178219536 - ], - "effective_rank": 6, - "scaled_condition_number": 4.985227704290952, - "weakest_scaled_direction": [ - 0.723870520577249, - 0.3838510953593598, - -0.01790185340485378, - -0.07665324471152675, - 0.1186541704141166, - -0.5553330510548116 - ] - }, - "forward_reverse": { - "translation_m": 0.005399786589867114, - "rotation_deg": 0.1389350777589359 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0269000349351378e-14, - "rotation_deg": 1.1966888576940126e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 3621, - "frame_counter_j": 5145, - "rtk_translation_m": 6.142548765456278, - "rtk_rotation_deg": 97.97753842317456, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.14208037102395846, - -0.9884298843565125, - -0.053099264407963725, - 2.170039415231362 - ], - [ - 0.989564713236412, - -0.1431335074041117, - 0.016567358737454824, - 6.182231813705039 - ], - [ - -0.0239759564362455, - -0.050191261880626434, - 0.9984517969054876, - 0.09208634545734894 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7590, - "backend_objective": 118.46903129923888, - "backend_elapsed_sec": 0.6824606999871321, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8899418479431402, - "inlier_rmse_m": 0.390935617658789, - "target_points": 5087, - "source_points": 4643 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7810807558069564, - "inlier_rmse_m": 0.1984380888165097, - "target_points": 8554, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6546489563567363, - "inlier_rmse_m": 0.12493425480473774, - "target_points": 11995, - "source_points": 11594 - } - ], - "heldout_symmetric": { - "evaluated": 8146, - "inliers": 5319, - "inlier_ratio": 0.6529585072428186, - "inlier_rmse_m": 0.11878586101480827, - "median_m": 0.14679529080051615, - "p90_m": 1.0979649139379524, - "p95_m": 1.6769030887461873 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2727.9660850560476, - 4535.405391289007, - 5149.977820649118, - 7589.999999999999, - 12172.37502339334, - 14525.884049585706 - ], - "effective_rank": 6, - "scaled_condition_number": 5.324803753668097, - "weakest_scaled_direction": [ - -0.6508853183419137, - -0.5355932196637113, - 0.008407772564635941, - 0.07096211835842292, - -0.07795601759091805, - 0.5275459713211308 - ] - }, - "forward_reverse": { - "translation_m": 0.011377811219747914, - "rotation_deg": 0.20418431358287809 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.902067138807519e-15, - "rotation_deg": 1.589543265306399e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 3621, - "frame_counter_j": 6006, - "rtk_translation_m": 5.314106070657687, - "rtk_rotation_deg": 123.28910472998356, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5516002666536794, - -0.8328088032698073, - -0.046547212847822074, - 2.4005277793802224 - ], - [ - 0.8334717346815668, - -0.5525004930146833, - 0.008250618487843116, - 3.9567696951837963 - ], - [ - -0.03258854575597747, - -0.034244742878914346, - 0.9988820171925554, - 0.08075055203991593 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8115, - "backend_objective": 124.48597459940477, - "backend_elapsed_sec": 0.7416901999968104, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9326923076923077, - "inlier_rmse_m": 0.3809512417092888, - "target_points": 5087, - "source_points": 4680 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8172959805115713, - "inlier_rmse_m": 0.19161868927591258, - "target_points": 8554, - "source_points": 8210 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6971649484536082, - "inlier_rmse_m": 0.12385568620067329, - "target_points": 11995, - "source_points": 11640 - } - ], - "heldout_symmetric": { - "evaluated": 8094, - "inliers": 5637, - "inlier_ratio": 0.6964418087472202, - "inlier_rmse_m": 0.11691192595448072, - "median_m": 0.1312825893978457, - "p90_m": 0.86598349894007, - "p95_m": 1.2859474928352328 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3442.045934786842, - 5814.377321586114, - 6615.623105124134, - 8114.999999999995, - 12192.35074779878, - 15195.691233042959 - ], - "effective_rank": 6, - "scaled_condition_number": 4.414726450762486, - "weakest_scaled_direction": [ - -0.6333246944994089, - -0.6175567347871079, - 0.012399209890566157, - 0.10660083882111507, - -0.10043565947726531, - 0.4426270548875275 - ] - }, - "forward_reverse": { - "translation_m": 0.017641796253111963, - "rotation_deg": 0.10886712169052283 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4124808308577039e-15, - "rotation_deg": 2.426668912087873e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 4371, - "frame_counter_j": 5145, - "rtk_translation_m": 1.9357867378988893, - "rtk_rotation_deg": 56.54578494904757, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5633985778261231, - -0.8255632254917628, - -0.03205313119089148, - 0.10312836671521534 - ], - [ - 0.8261770540030046, - 0.5631414894184164, - 0.017410868287486572, - 2.8741864803455264 - ], - [ - 0.0036766754573328724, - -0.03629081993075041, - 0.9993345077832223, - 0.048237954628261165 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8411, - "backend_objective": 120.86683809372273, - "backend_elapsed_sec": 0.6668355999863707, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.93194055567521, - "inlier_rmse_m": 0.35231182623801116, - "target_points": 4638, - "source_points": 4643 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8376459261042243, - "inlier_rmse_m": 0.1889531925451364, - "target_points": 8144, - "source_points": 8309 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7254614455752976, - "inlier_rmse_m": 0.1198753157248939, - "target_points": 11871, - "source_points": 11594 - } - ], - "heldout_symmetric": { - "evaluated": 8079, - "inliers": 6081, - "inlier_ratio": 0.7526921648718901, - "inlier_rmse_m": 0.10924852668609378, - "median_m": 0.10644907322627564, - "p90_m": 0.7127117267412296, - "p95_m": 1.290046767093283 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3621.1208669955477, - 5438.125007877232, - 6936.408184780728, - 8411.0, - 9674.972518309887, - 11912.770940146951 - ], - "effective_rank": 6, - "scaled_condition_number": 3.289802074469556, - "weakest_scaled_direction": [ - 0.886359167544377, - -0.08683928160690585, - 0.026237898727861694, - 0.02455684625077196, - 0.11842550150273999, - -0.4376188979539416 - ] - }, - "forward_reverse": { - "translation_m": 0.012374747586501101, - "rotation_deg": 0.14461856068326442 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6556497485417479e-15, - "rotation_deg": 1.9980685391398485e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 4371, - "frame_counter_j": 6006, - "rtk_translation_m": 0.19501559913675365, - "rtk_rotation_deg": 81.85735125585654, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.15573393600531066, - -0.987261645238883, - -0.032578904470621506, - -1.2255016856725545 - ], - [ - 0.9877909770551813, - 0.15551469257732836, - 0.009174205194425196, - 1.0764705380743882 - ], - [ - -0.003990842600752482, - -0.03360988296307088, - 0.999427060341345, - -0.007038132046144201 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8671, - "backend_objective": 137.23485431232746, - "backend_elapsed_sec": 1.4784595999808516, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9455128205128205, - "inlier_rmse_m": 0.3235724239457988, - "target_points": 4638, - "source_points": 4680 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8711327649208283, - "inlier_rmse_m": 0.19423813712402987, - "target_points": 8144, - "source_points": 8210 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7449312714776632, - "inlier_rmse_m": 0.1258049182006407, - "target_points": 11871, - "source_points": 11640 - } - ], - "heldout_symmetric": { - "evaluated": 8027, - "inliers": 6288, - "inlier_ratio": 0.7833561729164071, - "inlier_rmse_m": 0.11683079277948674, - "median_m": 0.11489700976495941, - "p90_m": 0.49575175847132263, - "p95_m": 0.9268544801884024 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4110.658396308195, - 5781.451528827495, - 7731.040282131096, - 8671.000000000002, - 9554.997630540438, - 11841.888464841973 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8807765869032655, - "weakest_scaled_direction": [ - 0.9151643725468923, - 0.05960693152033186, - 0.03135220397149887, - 0.0029672211289679565, - 0.14835843535784973, - -0.36867220467327777 - ] - }, - "forward_reverse": { - "translation_m": 0.0136898748124479, - "rotation_deg": 0.2000656277647698 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.1357966319673714e-15, - "rotation_deg": 1.7270876263660686e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 4371, - "frame_counter_j": 6878, - "rtk_translation_m": 1.8038807059856978, - "rtk_rotation_deg": 172.47951556359365, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9891772514494434, - -0.13864765671180998, - -0.048012420301912974, - -2.133772737547501 - ], - [ - 0.13994460673153777, - -0.9898492099457441, - -0.024780004369302243, - 1.887778167007043 - ], - [ - -0.04408936676431938, - -0.03123089589031211, - 0.9985393126363172, - -0.03234445223926235 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8213, - "backend_objective": 123.52383274027166, - "backend_elapsed_sec": 0.8436991999915335, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9001875390706398, - "inlier_rmse_m": 0.36104255626873755, - "target_points": 4638, - "source_points": 4799 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7987623467809116, - "inlier_rmse_m": 0.18742996468547785, - "target_points": 8144, - "source_points": 8403 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7020258141721515, - "inlier_rmse_m": 0.1226378329826847, - "target_points": 11871, - "source_points": 11699 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5996, - "inlier_ratio": 0.7410703250525275, - "inlier_rmse_m": 0.11436945722491815, - "median_m": 0.11947887817564241, - "p90_m": 0.7985221582320845, - "p95_m": 1.3658547387858935 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3551.0789075684697, - 6545.983138649887, - 7472.8475410968385, - 8213.000000000002, - 10663.106304496083, - 14122.270396839389 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9768956884456648, - "weakest_scaled_direction": [ - 0.8860999039752284, - -0.0720951249513293, - 0.03542904589224521, - 0.02943628694689152, - 0.1505074475845845, - -0.42994772830294414 - ] - }, - "forward_reverse": { - "translation_m": 0.020336999081352437, - "rotation_deg": 0.07548452187379719 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8161486092845457e-15, - "rotation_deg": 2.342686615842194e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 5145, - "frame_counter_j": 6006, - "rtk_translation_m": 2.130456053070114, - "rtk_rotation_deg": 25.311566306808988, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.903800983504866, - -0.4278753474410665, - -0.00815286868681444, - -2.2319556406663636 - ], - [ - 0.4278518763228547, - 0.9038375568764107, - -0.004521361154826322, - 0.08411508086415746 - ], - [ - 0.009303447890452421, - 0.0005981904934453193, - 0.9999565430684886, - -0.04186216117454321 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9432, - "backend_objective": 116.84125775349439, - "backend_elapsed_sec": 0.6598783000081312, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9517094017094017, - "inlier_rmse_m": 0.3052147766589594, - "target_points": 4643, - "source_points": 4680 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8965895249695494, - "inlier_rmse_m": 0.1665854381838512, - "target_points": 8309, - "source_points": 8210 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8103092783505155, - "inlier_rmse_m": 0.11130026942404483, - "target_points": 11594, - "source_points": 11640 - } - ], - "heldout_symmetric": { - "evaluated": 7928, - "inliers": 6737, - "inlier_ratio": 0.8497729566094854, - "inlier_rmse_m": 0.10415909908074772, - "median_m": 0.08959121987357384, - "p90_m": 0.3467987634497123, - "p95_m": 0.6202156796544128 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4378.264654153876, - 8116.253839815621, - 9076.712606203011, - 9432.0, - 11231.517385223337, - 14780.74183171763 - ], - "effective_rank": 6, - "scaled_condition_number": 3.375936129784756, - "weakest_scaled_direction": [ - 0.44302890658854316, - -0.8611369473587376, - 0.00022113385752086498, - 0.12027512666587031, - 0.061931697641039, - 0.20944415879479658 - ] - }, - "forward_reverse": { - "translation_m": 0.008986805974948919, - "rotation_deg": 0.1309947950641294 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.793620188084545e-15, - "rotation_deg": 1.3926017091562627e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 5145, - "frame_counter_j": 6878, - "rtk_translation_m": 0.24494500622098103, - "rtk_rotation_deg": 115.93373061454483, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.44191583004752333, - -0.8958733857158078, - -0.046057311249176024, - -2.078023274740148 - ], - [ - 0.8969926131748409, - -0.4419143850541915, - -0.010766995492992261, - 1.299787069288084 - ], - [ - -0.010707523671635305, - -0.046071173723609034, - 0.9988807716081788, - -0.020962857833613374 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8396, - "backend_objective": 115.63193237238191, - "backend_elapsed_sec": 0.6536257000116166, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9339445717857887, - "inlier_rmse_m": 0.35325124635681787, - "target_points": 4643, - "source_points": 4799 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8342258717124836, - "inlier_rmse_m": 0.18537787669707836, - "target_points": 8309, - "source_points": 8403 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.717668176767245, - "inlier_rmse_m": 0.11735529155507596, - "target_points": 11594, - "source_points": 11699 - } - ], - "heldout_symmetric": { - "evaluated": 7992, - "inliers": 6137, - "inlier_ratio": 0.7678928928928929, - "inlier_rmse_m": 0.11166725079781287, - "median_m": 0.10850260966882336, - "p90_m": 0.5857125674557123, - "p95_m": 0.9484334446688215 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4121.676609665293, - 6636.224746767371, - 7824.919080768352, - 8396.000000000002, - 10498.405365558141, - 13440.460053307019 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2609205733873607, - "weakest_scaled_direction": [ - 0.5601461938756791, - -0.8021211600225457, - 0.020768782846807436, - 0.1331026440671933, - 0.0961672636776285, - 0.12426619543873317 - ] - }, - "forward_reverse": { - "translation_m": 0.010085391730565987, - "rotation_deg": 0.11752836996157842 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.726334887614051e-15, - "rotation_deg": 1.065795996480427e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 5145, - "frame_counter_j": 7623, - "rtk_translation_m": 8.025985916230132, - "rtk_rotation_deg": 103.90638727582186, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.23911204026525565, - -0.9709194849860775, - -0.011865322353713376, - -4.886126629411354 - ], - [ - 0.9708400606362625, - -0.23927293328077537, - 0.014766179702001623, - 8.58532881015855 - ], - [ - -0.01717582207537421, - -0.007988558917878884, - 0.999820570933831, - 0.04270840144716096 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6357, - "backend_objective": 108.44204176153727, - "backend_elapsed_sec": 1.2956186999799684, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8377963125548727, - "inlier_rmse_m": 0.43113357705826366, - "target_points": 4643, - "source_points": 4556 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6966474856142106, - "inlier_rmse_m": 0.21076033048440843, - "target_points": 8309, - "source_points": 7994 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5636637701720163, - "inlier_rmse_m": 0.13060888961028494, - "target_points": 11594, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 8041, - "inliers": 4882, - "inlier_ratio": 0.6071384156199477, - "inlier_rmse_m": 0.12594282886521954, - "median_m": 0.17076642203258252, - "p90_m": 1.1943347502598551, - "p95_m": 1.8834422988645498 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2218.0677970003667, - 2835.5052632079855, - 3304.3564856991784, - 6357.000000000002, - 13356.784939760788, - 15265.848249160888 - ], - "effective_rank": 6, - "scaled_condition_number": 6.882498483502561, - "weakest_scaled_direction": [ - 0.6521439547130807, - 0.05181733797718935, - 0.01464458639605507, - 0.010164027465411772, - 0.0844365907105837, - -0.7513826698828533 - ] - }, - "forward_reverse": { - "translation_m": 0.01655440444551025, - "rotation_deg": 0.4345945520890901 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5510982866352577e-15, - "rotation_deg": 3.431223765900091e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 6006, - "frame_counter_j": 6878, - "rtk_translation_m": 1.9962664218365056, - "rtk_rotation_deg": 90.62216430773583, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.01558276574952197, - -0.9992735336457006, - -0.0347790506890377, - 0.6583296622690518 - ], - [ - 0.9998324688728506, - -0.015906671532669666, - 0.0090560470611042, - 1.027659166905885 - ], - [ - -0.009602687083139947, - -0.034632105855504726, - 0.9993539941606262, - 0.017443352131156144 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9150, - "backend_objective": 117.33018692584575, - "backend_elapsed_sec": 0.7429393000202253, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.954990623046468, - "inlier_rmse_m": 0.29563110884340815, - "target_points": 4680, - "source_points": 4799 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8907533023920029, - "inlier_rmse_m": 0.175726922895322, - "target_points": 8210, - "source_points": 8403 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7821181297546799, - "inlier_rmse_m": 0.11323855901911818, - "target_points": 11640, - "source_points": 11699 - } - ], - "heldout_symmetric": { - "evaluated": 7940, - "inliers": 6590, - "inlier_ratio": 0.8299748110831234, - "inlier_rmse_m": 0.10748525688830209, - "median_m": 0.09733808799368987, - "p90_m": 0.38497596317607363, - "p95_m": 0.6736313528695768 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4579.939240782556, - 8013.667552238668, - 9150.000000000004, - 9396.223910620382, - 9769.1170780297, - 13772.417375734603 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0071179226782414, - "weakest_scaled_direction": [ - 0.19440723479722805, - -0.9360883204353279, - 0.010869966309410657, - 0.17180760123971459, - 0.03295228977466592, - -0.23499494035054344 - ] - }, - "forward_reverse": { - "translation_m": 0.007106461978852689, - "rotation_deg": 0.10698728473689886 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0702197373587272e-15, - "rotation_deg": 7.565259576796879e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 6006, - "frame_counter_j": 7623, - "rtk_translation_m": 7.8811064994361235, - "rtk_rotation_deg": 78.59482096901284, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.19882603733712217, - -0.9799944951381478, - 0.00888799053440953, - 1.235570626865747 - ], - [ - 0.979827302649002, - 0.19896237779350526, - 0.018773097941966906, - 8.79754244391703 - ], - [ - -0.020165908370349192, - 0.004976115118957357, - 0.9997842639379372, - 0.08570864416362214 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6624, - "backend_objective": 112.67723694997159, - "backend_elapsed_sec": 1.017676699993899, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8437225636523266, - "inlier_rmse_m": 0.4138184403407402, - "target_points": 4680, - "source_points": 4556 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7206654991243433, - "inlier_rmse_m": 0.21035189337821336, - "target_points": 8210, - "source_points": 7994 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5873381805284625, - "inlier_rmse_m": 0.13042412521500604, - "target_points": 11640, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 7989, - "inliers": 4944, - "inlier_ratio": 0.6188509200150206, - "inlier_rmse_m": 0.1271320507839345, - "median_m": 0.17331809391203515, - "p90_m": 1.220010525510476, - "p95_m": 1.9166690177024657 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2265.2090757449982, - 3319.305199938711, - 3812.8132788214143, - 6624.000000000002, - 13070.92725801702, - 15215.363236013969 - ], - "effective_rank": 6, - "scaled_condition_number": 6.716979637303383, - "weakest_scaled_direction": [ - 0.49968124377683965, - -0.520786835385394, - 0.016511527979111488, - 0.08075029506904903, - 0.05576052174878799, - -0.6849797443802672 - ] - }, - "forward_reverse": { - "translation_m": 0.026230622734929154, - "rotation_deg": 0.28112746782878123 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.401779625492033e-15, - "rotation_deg": 6.543713954631931e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 6006, - "frame_counter_j": 8276, - "rtk_translation_m": 7.620696678413973, - "rtk_rotation_deg": 134.60031955305035, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7022381922683417, - -0.7102506789938965, - -0.04904583884897706, - -1.9924605167502298 - ], - [ - 0.7111311918834577, - -0.7030589645886992, - -0.0007212779479604502, - 8.490941631100316 - ], - [ - -0.03396982852626379, - -0.0353845347598958, - 0.9987962682397858, - 0.0416088571852517 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6732, - "backend_objective": 120.11915845955133, - "backend_elapsed_sec": 0.8221571999893058, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8522886268239056, - "inlier_rmse_m": 0.4282274765696279, - "target_points": 4680, - "source_points": 5003 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7016801785924098, - "inlier_rmse_m": 0.2080400960929964, - "target_points": 8210, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5590897765966282, - "inlier_rmse_m": 0.13357773859776764, - "target_points": 11640, - "source_points": 12041 - } - ], - "heldout_symmetric": { - "evaluated": 8077, - "inliers": 4650, - "inlier_ratio": 0.5757088027733069, - "inlier_rmse_m": 0.1313446077529101, - "median_m": 0.1946144416542199, - "p90_m": 1.323593894883393, - "p95_m": 1.901322689331278 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2810.0529980403535, - 3715.4390367725205, - 4388.964530931271, - 6731.999999999997, - 13604.0963800631, - 16173.36075280571 - ], - "effective_rank": 6, - "scaled_condition_number": 5.755535843660075, - "weakest_scaled_direction": [ - 0.526079746387773, - -0.46762447128873164, - 0.05159365970552225, - 0.15052947673163974, - 0.09366896662564102, - -0.6859100158890263 - ] - }, - "forward_reverse": { - "translation_m": 0.012710332356906473, - "rotation_deg": 0.2297418063823675 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.449557262054371e-15, - "rotation_deg": 1.4966378999110743e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 6878, - "frame_counter_j": 7623, - "rtk_translation_m": 7.803713858547152, - "rtk_rotation_deg": 12.027343338722998, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9767096719478493, - 0.2144252194497536, - 0.007748676496584432, - 7.764769934294107 - ], - [ - -0.21393458283489106, - 0.9759706183011247, - -0.041392589677138755, - -0.7085736704797382 - ], - [ - -0.016438095716500987, - 0.03877083281081081, - 0.9991129123038952, - 0.14368801979158632 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6758, - "backend_objective": 106.43104604599638, - "backend_elapsed_sec": 0.5688255999993999, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8733538191395961, - "inlier_rmse_m": 0.4062154576148282, - "target_points": 4799, - "source_points": 4556 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7450587940955716, - "inlier_rmse_m": 0.20931960528713373, - "target_points": 8403, - "source_points": 7994 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5992197198084767, - "inlier_rmse_m": 0.12549460951672864, - "target_points": 11699, - "source_points": 11278 - } - ], - "heldout_symmetric": { - "evaluated": 8053, - "inliers": 5095, - "inlier_ratio": 0.6326834719980131, - "inlier_rmse_m": 0.12084265385763356, - "median_m": 0.15459485205736714, - "p90_m": 1.1334968876463887, - "p95_m": 1.7368550339582725 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2556.5241489846394, - 3586.5887288383406, - 4201.742403851606, - 6758.000000000002, - 12069.008341790019, - 14162.350957366638 - ], - "effective_rank": 6, - "scaled_condition_number": 5.539689880493177, - "weakest_scaled_direction": [ - -0.6342297422054561, - -0.4837597469091066, - 0.011543415834932211, - 0.059361983473782465, - -0.09197546234327802, - -0.5929692742192461 - ] - }, - "forward_reverse": { - "translation_m": 0.02518064403521875, - "rotation_deg": 0.3859647522318924 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2262814116578437e-15, - "rotation_deg": 3.3478739948903655e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 6878, - "frame_counter_j": 8276, - "rtk_translation_m": 8.062504137991457, - "rtk_rotation_deg": 43.97815524531457, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7225332041091128, - -0.6912638748621069, - -0.010001213448674927, - 7.512466332351234 - ], - [ - 0.6913298199510078, - 0.7223886589673808, - 0.014754844689713971, - 2.526199124741081 - ], - [ - -0.0029747279419654123, - -0.01757500230255533, - 0.9998411225228427, - 0.19664447184321665 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7066, - "backend_objective": 125.5588381486651, - "backend_elapsed_sec": 1.3219921000127215, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8744753148111133, - "inlier_rmse_m": 0.3994120225676832, - "target_points": 4799, - "source_points": 5003 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7402185407120198, - "inlier_rmse_m": 0.21180167093341312, - "target_points": 8403, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5868283365169006, - "inlier_rmse_m": 0.13330204978659915, - "target_points": 11699, - "source_points": 12041 - } - ], - "heldout_symmetric": { - "evaluated": 8141, - "inliers": 5018, - "inlier_ratio": 0.6163861933423412, - "inlier_rmse_m": 0.12936028463965984, - "median_m": 0.17517692069296223, - "p90_m": 1.0596089970231133, - "p95_m": 1.5959485402144877 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3225.313875628074, - 3951.4723883254887, - 4871.2398926209835, - 7066.000000000002, - 12924.900835175798, - 15446.04718896907 - ], - "effective_rank": 6, - "scaled_condition_number": 4.789005902863088, - "weakest_scaled_direction": [ - -0.5769945052927932, - -0.5491654047534645, - 0.05329096616881885, - 0.11312213827094149, - -0.17372116945323146, - -0.5654017236668927 - ] - }, - "forward_reverse": { - "translation_m": 0.011327540721525892, - "rotation_deg": 0.17059480981566058 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0621477437872914e-15, - "rotation_deg": 9.30775426804605e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 6878, - "frame_counter_j": 8958, - "rtk_translation_m": 11.084531710563947, - "rtk_rotation_deg": 22.606708130954026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.924292692328189, - -0.38153520935512136, - -0.010672531614110135, - 10.41071960885304 - ], - [ - 0.38163830947455873, - 0.924254362488002, - 0.010299231199356166, - 3.9692817740566793 - ], - [ - 0.005934614571289277, - -0.01359255105718616, - 0.9998900054034195, - 0.29863131976956603 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 5560, - "backend_objective": 101.14364522975083, - "backend_elapsed_sec": 1.552222600003006, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8261874737284574, - "inlier_rmse_m": 0.44743598084381275, - "target_points": 4799, - "source_points": 4758 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6508780608459065, - "inlier_rmse_m": 0.22455109954890465, - "target_points": 8403, - "source_points": 8086 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.4875482286916871, - "inlier_rmse_m": 0.1348751389206923, - "target_points": 11699, - "source_points": 11404 - } - ], - "heldout_symmetric": { - "evaluated": 7853, - "inliers": 4218, - "inlier_ratio": 0.5371195721380364, - "inlier_rmse_m": 0.13463285672049757, - "median_m": 0.21934760785432297, - "p90_m": 1.3391122728682134, - "p95_m": 2.100876641505108 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2436.5596934848804, - 2988.96338883937, - 3643.7801893253, - 5560.000000000002, - 11937.627619236891, - 14212.460437580443 - ], - "effective_rank": 6, - "scaled_condition_number": 5.833003178860405, - "weakest_scaled_direction": [ - 0.1752035385778211, - 0.5796996149835907, - -0.024718665321678292, - -0.1272035359327248, - 0.07178387083565628, - 0.7818614969267024 - ] - }, - "forward_reverse": { - "translation_m": 0.017887959781482814, - "rotation_deg": 0.14919899299178907 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.32711859681733e-15, - "rotation_deg": 3.683762231671466e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 7623, - "frame_counter_j": 8276, - "rtk_translation_m": 2.04815062353057, - "rtk_rotation_deg": 56.00549858403758, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5584533153530602, - -0.828923943052278, - -0.031858926627231804, - -0.9318923804121199 - ], - [ - 0.8291128187254477, - 0.5565301321611406, - 0.053349281362047245, - 3.1015193784558486 - ], - [ - -0.02649204401926822, - -0.056207727505809865, - 0.9980675643323523, - -0.07350770557984843 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7542, - "backend_objective": 105.97368399665098, - "backend_elapsed_sec": 0.5776144999836106, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8880671597041775, - "inlier_rmse_m": 0.4165543605698942, - "target_points": 4556, - "source_points": 5003 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7399835506990953, - "inlier_rmse_m": 0.1903738892456968, - "target_points": 7994, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6263599368823187, - "inlier_rmse_m": 0.11853749684886764, - "target_points": 11278, - "source_points": 12041 - } - ], - "heldout_symmetric": { - "evaluated": 8190, - "inliers": 5359, - "inlier_ratio": 0.6543345543345543, - "inlier_rmse_m": 0.10729272360686735, - "median_m": 0.128911595256462, - "p90_m": 1.1228277858893216, - "p95_m": 1.724687313767321 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3708.2521888447404, - 6519.419167758891, - 7541.999999999999, - 7714.627097852169, - 8537.73361183201, - 12529.651399956132 - ], - "effective_rank": 6, - "scaled_condition_number": 3.3788563349731584, - "weakest_scaled_direction": [ - 0.7858561305151, - 0.42928312484744535, - 0.0005463466419317472, - -0.06694940265322938, - 0.12309692561222292, - -0.42250534522960576 - ] - }, - "forward_reverse": { - "translation_m": 0.008725655639009402, - "rotation_deg": 0.02870462611907292 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.122468574731976e-16, - "rotation_deg": 9.360381252683941e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 7623, - "frame_counter_j": 8958, - "rtk_translation_m": 4.738677237611319, - "rtk_rotation_deg": 34.634051469677026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8218352300147945, - -0.5688703070710996, - -0.03119981473284189, - 1.5846974397858378 - ], - [ - 0.5697163907317495, - 0.8202839087499226, - 0.050572158126157965, - 5.125839059211078 - ], - [ - -0.0031762931411466974, - -0.05933702704704953, - 0.9982329529639352, - -0.0122937659517854 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6141, - "backend_objective": 95.83039249845596, - "backend_elapsed_sec": 0.5702792000083718, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8173602353930223, - "inlier_rmse_m": 0.4529145793536717, - "target_points": 4556, - "source_points": 4758 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6587929755132328, - "inlier_rmse_m": 0.20413053522622102, - "target_points": 7994, - "source_points": 8086 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5384952648193616, - "inlier_rmse_m": 0.12492003141306962, - "target_points": 11278, - "source_points": 11404 - } - ], - "heldout_symmetric": { - "evaluated": 7902, - "inliers": 4598, - "inlier_ratio": 0.5818780055682106, - "inlier_rmse_m": 0.11717687815100752, - "median_m": 0.17181881274828115, - "p90_m": 1.3640782820675088, - "p95_m": 1.8256886182814358 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2987.308869239922, - 5270.382928013541, - 6109.687992263246, - 6141.0, - 7550.115127170244, - 10622.830106455349 - ], - "effective_rank": 6, - "scaled_condition_number": 3.555986532172074, - "weakest_scaled_direction": [ - 0.82326472083412, - 0.36257275472371464, - -0.01104743035998065, - -0.0674841057761342, - 0.1408062494700231, - -0.4077666573203338 - ] - }, - "forward_reverse": { - "translation_m": 0.009813025835682346, - "rotation_deg": 0.0603546019895227 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7064601008853095e-15, - "rotation_deg": 3.3921116242385096e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 7623, - "frame_counter_j": 9717, - "rtk_translation_m": 7.170741483679294, - "rtk_rotation_deg": 16.35622721712263, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9580757572202011, - -0.2857347836898251, - -0.021129998028052346, - 5.200435725127117 - ], - [ - 0.28643975938877914, - 0.956905887811991, - 0.04778478954691107, - 5.242590741804046 - ], - [ - 0.006565643017648578, - -0.05183391997980557, - 0.9986341357430625, - 0.12606486557808538 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6023, - "backend_objective": 106.40589964909799, - "backend_elapsed_sec": 1.201278900000034, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8284376330353341, - "inlier_rmse_m": 0.4571637917041393, - "target_points": 4556, - "source_points": 4698 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6582776717557252, - "inlier_rmse_m": 0.21616250289640723, - "target_points": 7994, - "source_points": 8384 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5088282504012841, - "inlier_rmse_m": 0.1329157427168759, - "target_points": 11278, - "source_points": 11837 - } - ], - "heldout_symmetric": { - "evaluated": 8124, - "inliers": 4370, - "inlier_ratio": 0.5379123584441162, - "inlier_rmse_m": 0.12645695585785732, - "median_m": 0.21654109527482085, - "p90_m": 1.3657698365089808, - "p95_m": 1.8184384805335867 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2499.324161804255, - 3493.6656389272193, - 4227.365341588677, - 6023.000000000001, - 10391.865876882504, - 12203.09542123824 - ], - "effective_rank": 6, - "scaled_condition_number": 4.882558096197038, - "weakest_scaled_direction": [ - 0.8684529949213924, - 0.33669660743243707, - -0.03884090022172433, - -0.07119250099549948, - 0.14635044346039885, - -0.32315530341689835 - ] - }, - "forward_reverse": { - "translation_m": 0.008862930161052695, - "rotation_deg": 0.11566409877698863 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.379404155611337e-15, - "rotation_deg": 8.235373850930155e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 8276, - "frame_counter_j": 8958, - "rtk_translation_m": 3.2047552083250137, - "rtk_rotation_deg": 21.371447114360556, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.931482062745526, - 0.3637820101007371, - -0.0019534355395409227, - 3.0883468633499653 - ], - [ - -0.363786069496666, - 0.9314793061773601, - -0.0024490413451749332, - -0.963570001891304 - ], - [ - 0.0009286675976662282, - 0.0029918707208973125, - 0.9999950931310025, - 0.07469968440437395 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7809, - "backend_objective": 116.25759369371049, - "backend_elapsed_sec": 1.106898399972124, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.944724674232871, - "inlier_rmse_m": 0.3488954095331405, - "target_points": 5003, - "source_points": 4758 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8314370516942864, - "inlier_rmse_m": 0.1964842527673148, - "target_points": 8511, - "source_points": 8086 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6847597334268678, - "inlier_rmse_m": 0.1220149239079259, - "target_points": 12041, - "source_points": 11404 - } - ], - "heldout_symmetric": { - "evaluated": 7990, - "inliers": 5688, - "inlier_ratio": 0.7118898623279099, - "inlier_rmse_m": 0.1192865608074921, - "median_m": 0.1350085899751497, - "p90_m": 0.6551490182784515, - "p95_m": 0.9276714523779558 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4191.620023684842, - 6709.811345600716, - 7624.357350807386, - 7808.999999999998, - 9811.898184638078, - 13497.869351720376 - ], - "effective_rank": 6, - "scaled_condition_number": 3.2202034715576238, - "weakest_scaled_direction": [ - 0.78482099958494, - -0.5018171566879318, - -0.019004340886612132, - 0.1084231933625081, - 0.15788495341810166, - 0.3085305941342627 - ] - }, - "forward_reverse": { - "translation_m": 0.0029529340190147615, - "rotation_deg": 0.0041769080934441144 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.474576228406686e-16, - "rotation_deg": 6.041141482202727e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 8276, - "frame_counter_j": 9717, - "rtk_translation_m": 6.291813977735496, - "rtk_rotation_deg": 39.64927136691496, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7725349244430632, - 0.6349700249079231, - 0.0016905573587062321, - 5.206427086985336 - ], - [ - -0.6349173465732423, - 0.7725003768317583, - -0.01109643254308647, - -3.9058272224005495 - ], - [ - -0.008351858244928975, - 0.007499017483841231, - 0.9999370036160448, - 0.0917432940137032 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7349, - "backend_objective": 123.06452839523351, - "backend_elapsed_sec": 0.6678230999968946, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8916560238399319, - "inlier_rmse_m": 0.4004831960201719, - "target_points": 5003, - "source_points": 4698 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7641937022900763, - "inlier_rmse_m": 0.20322170691893476, - "target_points": 8511, - "source_points": 8384 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6208498775027457, - "inlier_rmse_m": 0.12940537695397786, - "target_points": 12041, - "source_points": 11837 - } - ], - "heldout_symmetric": { - "evaluated": 8212, - "inliers": 5026, - "inlier_ratio": 0.6120311738918656, - "inlier_rmse_m": 0.1252565212812615, - "median_m": 0.17091345348780562, - "p90_m": 1.1259201953201292, - "p95_m": 1.6658207059378556 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3206.1007214318247, - 4637.048238606179, - 5401.154855203001, - 7348.999999999998, - 12443.071148511113, - 15042.019205814553 - ], - "effective_rank": 6, - "scaled_condition_number": 4.691686416856199, - "weakest_scaled_direction": [ - 0.7981725226133396, - -0.33580151518151236, - -0.04595142021459902, - 0.08763557401342212, - 0.1441799119603311, - 0.46859213894555357 - ] - }, - "forward_reverse": { - "translation_m": 0.005686910809265337, - "rotation_deg": 0.10204044727301474 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3440693017233997e-15, - "rotation_deg": 2.2591029712435135e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 8276, - "frame_counter_j": 10489, - "rtk_translation_m": 10.199392557022867, - "rtk_rotation_deg": 72.41150002956134, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.29044052113846325, - 0.9568654605959236, - -0.007265947933346569, - 7.2521452254993415 - ], - [ - -0.9564181174458185, - 0.2900487927930956, - -0.03370582176218846, - -7.3844984176363795 - ], - [ - -0.0301444572386759, - 0.016738820681880845, - 0.9994053850064875, - 0.13846147026610514 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6057, - "backend_objective": 109.06885102007745, - "backend_elapsed_sec": 0.778608999971766, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8223443223443223, - "inlier_rmse_m": 0.42401388092595405, - "target_points": 5003, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6761310084825636, - "inlier_rmse_m": 0.2130690540910365, - "target_points": 8511, - "source_points": 8488 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5254619588791533, - "inlier_rmse_m": 0.13419044164066332, - "target_points": 12041, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 7945, - "inliers": 4104, - "inlier_ratio": 0.516551290119572, - "inlier_rmse_m": 0.1354903305714049, - "median_m": 0.23583409303692335, - "p90_m": 1.6234411010634366, - "p95_m": 2.5041547750210427 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2163.39843023113, - 3024.3898736020496, - 3497.1996106257666, - 6057.000000000001, - 13911.47804140673, - 15893.501074487602 - ], - "effective_rank": 6, - "scaled_condition_number": 7.346543684414892, - "weakest_scaled_direction": [ - 0.7238547120872566, - -0.24126958037326707, - -0.050054121888334434, - 0.08643763337192334, - 0.1295952290598316, - 0.6253411408180031 - ] - }, - "forward_reverse": { - "translation_m": 0.01356504272158301, - "rotation_deg": 0.3255230434099281 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.8266474299528865e-15, - "rotation_deg": 1.7951954799618946e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 8958, - "frame_counter_j": 9717, - "rtk_translation_m": 3.467398797536633, - "rtk_rotation_deg": 18.277824252554396, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9504911597929431, - 0.31073232461248496, - 0.0034608664221481076, - 3.045417875094758 - ], - [ - -0.31069783796454997, - 0.950474939957655, - -0.008015110519942713, - -1.9660465989593203 - ], - [ - -0.00578002072868046, - 0.0065430079791234256, - 0.9999618894772746, - 0.021667324844726197 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7611, - "backend_objective": 120.44152218333895, - "backend_elapsed_sec": 1.0538954999938142, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.921455938697318, - "inlier_rmse_m": 0.37333205934375135, - "target_points": 4758, - "source_points": 4698 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.798425572519084, - "inlier_rmse_m": 0.2043338096839637, - "target_points": 8086, - "source_points": 8384 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6429838641547689, - "inlier_rmse_m": 0.125796123106139, - "target_points": 11404, - "source_points": 11837 - } - ], - "heldout_symmetric": { - "evaluated": 7924, - "inliers": 5155, - "inlier_ratio": 0.650555275113579, - "inlier_rmse_m": 0.12104882943540958, - "median_m": 0.15351410004943652, - "p90_m": 0.933208115012442, - "p95_m": 1.3620912971744101 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2998.6794915842415, - 5608.739992988762, - 6321.129720466805, - 7610.999999999996, - 10814.172496618425, - 13830.652846173398 - ], - "effective_rank": 6, - "scaled_condition_number": 4.612247786063486, - "weakest_scaled_direction": [ - 0.825061005823877, - -0.2380800552946838, - -0.018410677581206063, - 0.044771231521114986, - 0.1167512168766514, - 0.4966064448601905 - ] - }, - "forward_reverse": { - "translation_m": 0.003583199374499245, - "rotation_deg": 0.03300207707174736 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.964831480998304e-15, - "rotation_deg": 5.442356387182279e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 8958, - "frame_counter_j": 10489, - "rtk_translation_m": 7.516502113110916, - "rtk_rotation_deg": 51.04005291520078, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6183034305645991, - 0.7859195840033362, - 0.0055924263135183365, - 6.204550896670852 - ], - [ - -0.7853262526498793, - 0.6180863926388387, - -0.035098263968536346, - -4.459590590126785 - ], - [ - -0.031041015623612393, - 0.01730949781859198, - 0.9993682187433837, - 0.05932565678165204 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6486, - "backend_objective": 109.92726224231119, - "backend_elapsed_sec": 2.275462999998126, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8536833536833537, - "inlier_rmse_m": 0.4126230022358423, - "target_points": 4758, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7132422243166824, - "inlier_rmse_m": 0.21004376743736744, - "target_points": 8086, - "source_points": 8488 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5626789277348834, - "inlier_rmse_m": 0.13018598513278615, - "target_points": 11404, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 7657, - "inliers": 4363, - "inlier_ratio": 0.5698054068172914, - "inlier_rmse_m": 0.12858662743221627, - "median_m": 0.1936224172404975, - "p90_m": 1.4095752781651825, - "p95_m": 2.071172510941281 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2050.4088329164606, - 3916.126929138444, - 4945.45984893723, - 6486.000000000002, - 12668.198251733651, - 15459.63862290608 - ], - "effective_rank": 6, - "scaled_condition_number": 7.539783468898054, - "weakest_scaled_direction": [ - 0.7600553669439282, - 0.010238959021600436, - -0.0176551755056268, - 0.01355739541549533, - 0.10001439011022722, - 0.6416483588977511 - ] - }, - "forward_reverse": { - "translation_m": 0.016001435752891854, - "rotation_deg": 0.11059625579949509 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9984014443252818e-15, - "rotation_deg": 1.677610469981635e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 8958, - "frame_counter_j": 11340, - "rtk_translation_m": 3.767517331528496, - "rtk_rotation_deg": 20.548768889074672, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9420984993444307, - 0.33533365402756454, - -0.001325899502177561, - 3.6279299654891535 - ], - [ - -0.33531475610092154, - 0.9419858861484643, - -0.015053392908939985, - -1.206440330533338 - ], - [ - -0.0037989306321649526, - 0.014626372537741504, - 0.9998858121567864, - 0.05361883461674421 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7413, - "backend_objective": 121.20528002077937, - "backend_elapsed_sec": 1.3571733999997377, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9104951333051207, - "inlier_rmse_m": 0.3699184387178016, - "target_points": 4758, - "source_points": 4726 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7736099384875166, - "inlier_rmse_m": 0.20449916918127523, - "target_points": 8086, - "source_points": 8291 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6238848678673624, - "inlier_rmse_m": 0.12786855858559512, - "target_points": 11404, - "source_points": 11882 - } - ], - "heldout_symmetric": { - "evaluated": 7988, - "inliers": 5129, - "inlier_ratio": 0.6420881321982974, - "inlier_rmse_m": 0.12414062948335584, - "median_m": 0.1606120477261961, - "p90_m": 0.9577784057886718, - "p95_m": 1.4049787773272133 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2875.3219668461825, - 5571.304824971685, - 6518.132957754168, - 7413.0, - 10891.003048123157, - 14239.356476050812 - ], - "effective_rank": 6, - "scaled_condition_number": 4.9522650472668115, - "weakest_scaled_direction": [ - 0.8297488911987154, - -0.12313164559136125, - -0.014093290402182585, - 0.02702851764889075, - 0.12150068882361927, - 0.5297771195731228 - ] - }, - "forward_reverse": { - "translation_m": 0.012369101516230236, - "rotation_deg": 0.018705060406060074 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2205327837301123e-15, - "rotation_deg": 2.5921922372355474e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 9717, - "frame_counter_j": 10489, - "rtk_translation_m": 4.049286119591895, - "rtk_rotation_deg": 32.762228662646386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8316930017610544, - 0.5551856829603824, - 0.007457094440977263, - 3.7881102078444724 - ], - [ - -0.5548896669202849, - 0.8315737478805925, - -0.0241362669217927, - -1.3868344031825495 - ], - [ - -0.019601233807672563, - 0.015936099636944832, - 0.9996808652572972, - 0.06767787853020736 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7848, - "backend_objective": 116.2900075398938, - "backend_elapsed_sec": 0.8782197999826167, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.905982905982906, - "inlier_rmse_m": 0.35360175793503157, - "target_points": 4698, - "source_points": 4914 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8124410933081998, - "inlier_rmse_m": 0.19235489312976103, - "target_points": 8384, - "source_points": 8488 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6808362973887395, - "inlier_rmse_m": 0.12172834071077489, - "target_points": 11837, - "source_points": 11527 - } - ], - "heldout_symmetric": { - "evaluated": 7879, - "inliers": 5494, - "inlier_ratio": 0.6972966112450819, - "inlier_rmse_m": 0.11680896213116294, - "median_m": 0.13156173217475128, - "p90_m": 0.8313148549051547, - "p95_m": 1.2148739230962617 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3141.754884667448, - 5542.2348035441155, - 6290.437184548331, - 7847.999999999999, - 10749.612255893424, - 13453.773551694301 - ], - "effective_rank": 6, - "scaled_condition_number": 4.282247993741361, - "weakest_scaled_direction": [ - 0.8546032035420024, - 0.22562426401969735, - -0.014729193713307361, - -0.022761946146888333, - 0.11574593324020838, - 0.4523437626184671 - ] - }, - "forward_reverse": { - "translation_m": 0.011410238767832601, - "rotation_deg": 0.04779713993430858 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1801832636420706e-15, - "rotation_deg": 2.0478961671665586e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 9717, - "frame_counter_j": 11340, - "rtk_translation_m": 0.97948616772873, - "rtk_rotation_deg": 2.2709446365202806, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9996632542520232, - 0.025943930837066552, - 0.0005390278072598082, - 0.3067349767416293 - ], - [ - -0.025939144761757, - 0.9996351962290823, - -0.007525638117062724, - 0.9020004675970495 - ], - [ - -0.0007340758026969609, - 0.007509121970102925, - 0.999971536704899, - 0.027483902952858734 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10410, - "backend_objective": 103.39761162728539, - "backend_elapsed_sec": 1.1478916000050958, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9741853575962759, - "inlier_rmse_m": 0.2532774382510327, - "target_points": 4698, - "source_points": 4726 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9261850199010976, - "inlier_rmse_m": 0.13836917396286044, - "target_points": 8384, - "source_points": 8291 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8761151321326376, - "inlier_rmse_m": 0.099662066674543, - "target_points": 11837, - "source_points": 11882 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 7183, - "inlier_ratio": 0.8749086479902558, - "inlier_rmse_m": 0.09521299965540617, - "median_m": 0.0760050517356585, - "p90_m": 0.31584076913196313, - "p95_m": 0.673397631101223 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5138.022407507219, - 9805.60705821039, - 10410.0, - 10753.164636145257, - 12219.744983907198, - 17005.28778909972 - ], - "effective_rank": 6, - "scaled_condition_number": 3.309695139564419, - "weakest_scaled_direction": [ - 0.9464821684170598, - 0.19993863080218655, - -0.003268578066919626, - -0.03608973188950048, - 0.17379902717424758, - 0.18076723869201752 - ] - }, - "forward_reverse": { - "translation_m": 0.006159472215773642, - "rotation_deg": 0.014929948455572307 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.9445856682867874e-15, - "rotation_deg": 6.9641562227049605e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 9717, - "frame_counter_j": 12056, - "rtk_translation_m": 4.286747470271891, - "rtk_rotation_deg": 25.863710300929224, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8973493412322633, - 0.4413020270750524, - 0.004084199979461093, - 4.163706947306015 - ], - [ - -0.44117658377204255, - 0.8972541055374322, - -0.017271132778489184, - -0.3292117219716087 - ], - [ - -0.011286351104437022, - 0.013696386226731722, - 0.9998425012386079, - 0.09325532492473072 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8094, - "backend_objective": 122.85748927338736, - "backend_elapsed_sec": 0.5855846999911591, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9071414120979162, - "inlier_rmse_m": 0.34639151284733327, - "target_points": 4698, - "source_points": 4943 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8155351249410655, - "inlier_rmse_m": 0.1924532178027488, - "target_points": 8384, - "source_points": 8484 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.691322172873249, - "inlier_rmse_m": 0.1232024141390483, - "target_points": 11837, - "source_points": 11708 - } - ], - "heldout_symmetric": { - "evaluated": 7898, - "inliers": 5546, - "inlier_ratio": 0.7022030893897189, - "inlier_rmse_m": 0.11797995277580095, - "median_m": 0.13317843027114487, - "p90_m": 0.7563323657972744, - "p95_m": 1.1686828731658028 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3318.8016894626558, - 5729.884918603264, - 6491.25484392026, - 8093.999999999997, - 11328.63842981768, - 14195.287398964416 - ], - "effective_rank": 6, - "scaled_condition_number": 4.2772327867721325, - "weakest_scaled_direction": [ - 0.8205546509352113, - 0.3195507628131044, - -0.018395091801162153, - -0.036964783445293935, - 0.1211852610411865, - 0.4562748433817121 - ] - }, - "forward_reverse": { - "translation_m": 0.008495008365045943, - "rotation_deg": 0.102782991447036 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.463236069784172e-16, - "rotation_deg": 5.901842100868137e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 10489, - "frame_counter_j": 11340, - "rtk_translation_m": 4.006260191078547, - "rtk_rotation_deg": 30.491284026126113, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8458702243136537, - -0.5331846831105824, - -0.014753213746047256, - -4.171321162531942 - ], - [ - 0.5333531564800941, - 0.8458097203519044, - 0.01184598796862743, - -0.03339321688991969 - ], - [ - 0.0061623122516516905, - -0.01788884161991954, - 0.9998209916045998, - -0.11569214825735312 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7798, - "backend_objective": 114.37676008268265, - "backend_elapsed_sec": 1.2714206000091508, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9325010579771477, - "inlier_rmse_m": 0.38250772409200645, - "target_points": 4914, - "source_points": 4726 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8071402725847304, - "inlier_rmse_m": 0.1999047450281883, - "target_points": 8488, - "source_points": 8291 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6562868204006059, - "inlier_rmse_m": 0.12110924025114314, - "target_points": 11527, - "source_points": 11882 - } - ], - "heldout_symmetric": { - "evaluated": 7943, - "inliers": 5525, - "inlier_ratio": 0.6955810147299509, - "inlier_rmse_m": 0.1145595612270532, - "median_m": 0.12784987509132364, - "p90_m": 0.8963798525645535, - "p95_m": 1.297397246398276 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3638.512993457, - 5440.134349762298, - 6741.499013663021, - 7797.999999999997, - 9887.48104214368, - 12190.07328500843 - ], - "effective_rank": 6, - "scaled_condition_number": 3.350289886810732, - "weakest_scaled_direction": [ - 0.693873019765956, - 0.6912207861777041, - 0.019388788721967684, - -0.09152119039784189, - 0.09610465823106085, - -0.15088372491126195 - ] - }, - "forward_reverse": { - "translation_m": 0.010228664633443074, - "rotation_deg": 0.03515966054944097 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.219600661539615e-15, - "rotation_deg": 1.2342067918868074e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 10489, - "frame_counter_j": 12056, - "rtk_translation_m": 0.9562774815922267, - "rtk_rotation_deg": 6.898518361717157, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9913367441541354, - -0.13128570051939975, - -0.003940117892710185, - -0.27816467224165836 - ], - [ - 0.13129871838452753, - 0.9913375251194534, - 0.003249283092896293, - 1.089325211064333 - ], - [ - 0.003479402313401459, - -0.003738466151743683, - 0.9999869587301498, - 0.005503141095767833 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9864, - "backend_objective": 123.01458376507152, - "backend_elapsed_sec": 0.7187746000126936, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.987052397329557, - "inlier_rmse_m": 0.2650029276509842, - "target_points": 4914, - "source_points": 4943 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9289250353606789, - "inlier_rmse_m": 0.15504934033296122, - "target_points": 8488, - "source_points": 8484 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8425008541168432, - "inlier_rmse_m": 0.11167392201666373, - "target_points": 11527, - "source_points": 11708 - } - ], - "heldout_symmetric": { - "evaluated": 7631, - "inliers": 6626, - "inlier_ratio": 0.868300353819945, - "inlier_rmse_m": 0.10454213568084784, - "median_m": 0.08419507912574345, - "p90_m": 0.302121023640418, - "p95_m": 0.5474606388498328 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5253.598453250472, - 9217.591651478237, - 9864.0, - 9919.974515381253, - 12324.703428703971, - 17041.28492664738 - ], - "effective_rank": 6, - "scaled_condition_number": 3.243735713395398, - "weakest_scaled_direction": [ - -0.5774945177885069, - -0.7830881214237311, - -0.002372059076880627, - 0.1409060715951762, - -0.10436686808495367, - 0.15006826839395646 - ] - }, - "forward_reverse": { - "translation_m": 0.0023750253827712867, - "rotation_deg": 0.010725047644197173 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.243667496954031e-15, - "rotation_deg": 1.0102386058610471e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 10489, - "frame_counter_j": 12805, - "rtk_translation_m": 3.565173336606111, - "rtk_rotation_deg": 18.944899794614482, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9489573496703038, - 0.31461803897240476, - 0.02225843794770864, - 3.4146271782161772 - ], - [ - -0.31383617588295293, - 0.9489134395376143, - -0.03271297864853416, - 0.44823850175161317 - ], - [ - -0.03141342410304273, - 0.02405771847149733, - 0.9992169048650393, - 0.07337683715324038 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8363, - "backend_objective": 116.4447665223749, - "backend_elapsed_sec": 0.9975955999980215, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.928635147190009, - "inlier_rmse_m": 0.33947582046875263, - "target_points": 4914, - "source_points": 4484 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8543104530053959, - "inlier_rmse_m": 0.18629629869885217, - "target_points": 8488, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7487689139582774, - "inlier_rmse_m": 0.11799916628154375, - "target_points": 11527, - "source_points": 11169 - } - ], - "heldout_symmetric": { - "evaluated": 7877, - "inliers": 5723, - "inlier_ratio": 0.7265456392027422, - "inlier_rmse_m": 0.10962529664062398, - "median_m": 0.11054371280254638, - "p90_m": 0.6354952577888515, - "p95_m": 1.0205758997107361 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3766.851570287908, - 6138.72779212131, - 7250.108359264892, - 8363.000000000004, - 10555.423880318049, - 13269.68173490696 - ], - "effective_rank": 6, - "scaled_condition_number": 3.522751424445623, - "weakest_scaled_direction": [ - -0.560200456647656, - -0.7615404390193128, - -0.0011282109237957354, - 0.0919696864388781, - -0.06720185395086006, - -0.30537816367913906 - ] - }, - "forward_reverse": { - "translation_m": 0.008958927594995584, - "rotation_deg": 0.0304143851242741 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.023951298512e-15, - "rotation_deg": 1.1222781979565583e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 11340, - "frame_counter_j": 12056, - "rtk_translation_m": 4.019575892829469, - "rtk_rotation_deg": 23.592765664408944, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9085817038105068, - 0.4176909635587484, - 0.0036805518826767522, - 3.8894614691461404 - ], - [ - -0.41762784716535645, - 0.9085455999559572, - -0.011483643703123741, - -1.1296956821139466 - ], - [ - -0.008140563421938684, - 0.008896727602594277, - 0.9999272870889855, - 0.07938515837747213 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8047, - "backend_objective": 123.04066174031752, - "backend_elapsed_sec": 0.7005369999969844, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8885292332591543, - "inlier_rmse_m": 0.3522301956839582, - "target_points": 4726, - "source_points": 4943 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7965582272512965, - "inlier_rmse_m": 0.18813727340916792, - "target_points": 8291, - "source_points": 8484 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6873078237102835, - "inlier_rmse_m": 0.12365376049354522, - "target_points": 11882, - "source_points": 11708 - } - ], - "heldout_symmetric": { - "evaluated": 7962, - "inliers": 5669, - "inlier_ratio": 0.7120070334086913, - "inlier_rmse_m": 0.11868441290330693, - "median_m": 0.1330779467518129, - "p90_m": 0.81031334830583, - "p95_m": 1.3422452040948158 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3062.3520103677665, - 5648.9236594670265, - 6389.000366652995, - 8047.000000000002, - 11135.974376352187, - 14149.88063807102 - ], - "effective_rank": 6, - "scaled_condition_number": 4.620592469502459, - "weakest_scaled_direction": [ - 0.794987329307692, - 0.28380733337029174, - -0.014973167762010391, - -0.029316241889193902, - 0.10975162141484261, - 0.5237551790397356 - ] - }, - "forward_reverse": { - "translation_m": 0.002571958018982041, - "rotation_deg": 0.05506919751152759 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.733642401122889e-15, - "rotation_deg": 1.2219809956695224e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 11340, - "frame_counter_j": 12805, - "rtk_translation_m": 7.5676649485439835, - "rtk_rotation_deg": 49.43618382074059, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.634952027333241, - 0.7725245239434985, - 0.006463968694208926, - 6.661587595072871 - ], - [ - -0.7709793147734765, - 0.634171164388126, - -0.058462213865286085, - -3.640352865203487 - ], - [ - -0.04926275648833796, - 0.03213711506157451, - 0.9982686946201862, - 0.06758619107401062 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6764, - "backend_objective": 108.58480297289505, - "backend_elapsed_sec": 0.789298499992583, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8037466547725245, - "inlier_rmse_m": 0.41549167268224224, - "target_points": 4726, - "source_points": 4484 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7126364663069394, - "inlier_rmse_m": 0.20058439494066638, - "target_points": 8291, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6056047989972244, - "inlier_rmse_m": 0.12670178237787888, - "target_points": 11882, - "source_points": 11169 - } - ], - "heldout_symmetric": { - "evaluated": 8208, - "inliers": 4858, - "inlier_ratio": 0.5918615984405458, - "inlier_rmse_m": 0.12229328437386527, - "median_m": 0.17682842053697545, - "p90_m": 1.2950395789503548, - "p95_m": 1.9530785060949778 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1975.4540324646355, - 3599.750324099419, - 4138.859969475179, - 6764.000000000002, - 11985.932016206303, - 14123.527990590419 - ], - "effective_rank": 6, - "scaled_condition_number": 7.149509813179243, - "weakest_scaled_direction": [ - 0.7225842505231805, - 0.2834428657194434, - -0.007798500851411782, - -0.020067005501398918, - 0.06839181386157428, - 0.6264113674255958 - ] - }, - "forward_reverse": { - "translation_m": 0.014273957859022303, - "rotation_deg": 0.25325650727956367 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.9941035183565725e-15, - "rotation_deg": 3.101412868091446e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 11340, - "frame_counter_j": 14288, - "rtk_translation_m": 5.910977627463022, - "rtk_rotation_deg": 0.8461207481731591, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999829151109813, - 0.00529409933431753, - 0.0024783055464976, - 5.88954102842528 - ], - [ - -0.005300237096573332, - 0.9999828867873494, - 0.0024766144552281623, - 0.516955815245443 - ], - [ - -0.0024651516917889842, - -0.002489707749539244, - 0.9999938621723932, - 0.13876896767640262 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7636, - "backend_objective": 126.1438615368881, - "backend_elapsed_sec": 0.7311048000119627, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.884018456375839, - "inlier_rmse_m": 0.37207003934870925, - "target_points": 4726, - "source_points": 4768 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7725494989000244, - "inlier_rmse_m": 0.19700990533126558, - "target_points": 8291, - "source_points": 8182 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6536551960280774, - "inlier_rmse_m": 0.12852869586058943, - "target_points": 11882, - "source_points": 11682 - } - ], - "heldout_symmetric": { - "evaluated": 8046, - "inliers": 5386, - "inlier_ratio": 0.6694009445687298, - "inlier_rmse_m": 0.12443900216431929, - "median_m": 0.14990803556261834, - "p90_m": 0.8893078182265395, - "p95_m": 1.4156361288783759 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2963.6932124320733, - 4965.495213536636, - 5747.900032842799, - 7635.999999999998, - 12313.890969386013, - 15285.963266669736 - ], - "effective_rank": 6, - "scaled_condition_number": 5.157741429696001, - "weakest_scaled_direction": [ - 0.6651184757858478, - 0.4433951340515224, - -0.030329072793758537, - -0.05889132195018103, - 0.1282361155904706, - 0.5832543411483894 - ] - }, - "forward_reverse": { - "translation_m": 0.017895201000461415, - "rotation_deg": 0.10920228290609475 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.424763686264159e-15, - "rotation_deg": 5.7290601056814575e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 12056, - "frame_counter_j": 12805, - "rtk_translation_m": 3.7301261399251735, - "rtk_rotation_deg": 25.84341815633164, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.899344491274164, - 0.43664946374658864, - 0.022731736067271795, - 3.5720600394616793 - ], - [ - -0.4355626508439342, - 0.8992317957662932, - -0.04083325449596031, - -1.1210835648002877 - ], - [ - -0.038270918523347304, - 0.0268220672719923, - 0.9989073598200366, - 0.03467327433363931 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8103, - "backend_objective": 115.10097737337574, - "backend_elapsed_sec": 0.7355102000001352, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9125780553077609, - "inlier_rmse_m": 0.35810545737090316, - "target_points": 4943, - "source_points": 4484 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8221859706362153, - "inlier_rmse_m": 0.18174750936776082, - "target_points": 8484, - "source_points": 7969 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7254901960784313, - "inlier_rmse_m": 0.11918362384650298, - "target_points": 11708, - "source_points": 11169 - } - ], - "heldout_symmetric": { - "evaluated": 7896, - "inliers": 5550, - "inlier_ratio": 0.702887537993921, - "inlier_rmse_m": 0.11495230769293868, - "median_m": 0.12764639935061928, - "p90_m": 0.8288317910751664, - "p95_m": 1.2559325090289875 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3881.6517361266197, - 6701.163766997258, - 7672.7397121977065, - 8102.999999999998, - 9901.414246263557, - 13742.172733100482 - ], - "effective_rank": 6, - "scaled_condition_number": 3.540289976352534, - "weakest_scaled_direction": [ - 0.4237980707935003, - 0.7731099251319827, - 0.019408840297256848, - -0.10664566345916048, - 0.04699039508478471, - 0.4568786939742035 - ] - }, - "forward_reverse": { - "translation_m": 0.013545291843393993, - "rotation_deg": 0.033466251783377816 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.393112024019675e-15, - "rotation_deg": 1.1925573850462548e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 12056, - "frame_counter_j": 14288, - "rtk_translation_m": 2.2049738368271745, - "rtk_rotation_deg": 24.438886412582093, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9108639684885562, - -0.4126548990453869, - -0.006539510923615718, - 1.1338180164985336 - ], - [ - 0.4127060336414471, - 0.9107768630521044, - 0.012618855927291435, - 2.3330790037976663 - ], - [ - 0.000748802526160962, - -0.014192956802958366, - 0.9998989945349315, - 0.04294852548406272 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8407, - "backend_objective": 128.91147136524086, - "backend_elapsed_sec": 0.7574913999997079, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9429530201342282, - "inlier_rmse_m": 0.3380315851516256, - "target_points": 4943, - "source_points": 4768 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8501588853581031, - "inlier_rmse_m": 0.1946211008493029, - "target_points": 8484, - "source_points": 8182 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7196541688067112, - "inlier_rmse_m": 0.1238298249453751, - "target_points": 11708, - "source_points": 11682 - } - ], - "heldout_symmetric": { - "evaluated": 7734, - "inliers": 5746, - "inlier_ratio": 0.7429531936901991, - "inlier_rmse_m": 0.11679524427533879, - "median_m": 0.12330148283366957, - "p90_m": 0.64427149781835, - "p95_m": 1.0354822042207965 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3938.325647314345, - 6262.635126537647, - 7404.541013919073, - 8407.0, - 11062.579084900706, - 13889.152833463806 - ], - "effective_rank": 6, - "scaled_condition_number": 3.526664394280145, - "weakest_scaled_direction": [ - -0.42976677673091224, - -0.8533743062481273, - 0.00860013874048403, - 0.14556615714715207, - -0.07577790738476606, - -0.24504499854779915 - ] - }, - "forward_reverse": { - "translation_m": 0.00989411002791081, - "rotation_deg": 0.07786907370564648 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5582722720639762e-15, - "rotation_deg": 4.8926578241264104e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 12056, - "frame_counter_j": 15094, - "rtk_translation_m": 4.7000039832559155, - "rtk_rotation_deg": 3.452521908779401, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9978994945680784, - 0.06471847600639648, - -0.0028491409554944995, - 3.626469146678099 - ], - [ - -0.06472568862427472, - 0.9978999210619623, - -0.002516500872850137, - 2.8934831496969533 - ], - [ - 0.0026802934332227344, - 0.002695627559429288, - 0.9999927747834845, - 0.13855624656070709 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7973, - "backend_objective": 116.7419023547869, - "backend_elapsed_sec": 1.4287633999774698, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9174889775351669, - "inlier_rmse_m": 0.35632509909926824, - "target_points": 4943, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8240157966185363, - "inlier_rmse_m": 0.18469053885985545, - "target_points": 8484, - "source_points": 8103 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7188711567937968, - "inlier_rmse_m": 0.12100477291289735, - "target_points": 11708, - "source_points": 11091 - } - ], - "heldout_symmetric": { - "evaluated": 7465, - "inliers": 5382, - "inlier_ratio": 0.7209645010046886, - "inlier_rmse_m": 0.11716134583909153, - "median_m": 0.12606695398189235, - "p90_m": 0.8652917735066014, - "p95_m": 1.5501402641436004 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3732.8078478517536, - 5928.628321973292, - 6734.234058310759, - 7972.999999999997, - 12093.773724899498, - 15398.69799344495 - ], - "effective_rank": 6, - "scaled_condition_number": 4.125231895423432, - "weakest_scaled_direction": [ - 0.2834056540616633, - 0.8322009351661683, - -0.0037831621275593945, - -0.14730884306896833, - 0.05221256912814698, - 0.4502027085852247 - ] - }, - "forward_reverse": { - "translation_m": 0.011654729311847106, - "rotation_deg": 0.13683586564190353 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.191854738971276e-15, - "rotation_deg": 9.96614732312677e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 12805, - "frame_counter_j": 14288, - "rtk_translation_m": 3.368526196086246, - "rtk_rotation_deg": 50.282304568913744, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6396373047277752, - -0.7668703648512283, - -0.052668414761888424, - -3.693042416723294 - ], - [ - 0.7686336883283444, - 0.638824422288708, - 0.033250724116393064, - 2.046222757634189 - ], - [ - 0.008146874698419515, - -0.06175112145089388, - 0.9980583286723305, - -0.16313654380279113 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6450, - "backend_objective": 94.97025313076063, - "backend_elapsed_sec": 0.7382106000150088, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8586409395973155, - "inlier_rmse_m": 0.4423853047544671, - "target_points": 4484, - "source_points": 4768 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6912735272549498, - "inlier_rmse_m": 0.20924373323642947, - "target_points": 7969, - "source_points": 8182 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5521314843348741, - "inlier_rmse_m": 0.12134277997817218, - "target_points": 11169, - "source_points": 11682 - } - ], - "heldout_symmetric": { - "evaluated": 7980, - "inliers": 4939, - "inlier_ratio": 0.618922305764411, - "inlier_rmse_m": 0.11254196340939995, - "median_m": 0.14934203444060978, - "p90_m": 1.2292528156499047, - "p95_m": 1.7156496206206349 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2643.044298420247, - 5005.92040619325, - 5640.334155109635, - 6450.000000000002, - 8193.264371358726, - 10753.57510905198 - ], - "effective_rank": 6, - "scaled_condition_number": 4.068632188828396, - "weakest_scaled_direction": [ - -0.08917064780872991, - -0.8793698047617977, - 0.004434951408727184, - 0.10881394524164172, - -0.008740466719060716, - 0.45477555212549964 - ] - }, - "forward_reverse": { - "translation_m": 0.03104786021350874, - "rotation_deg": 0.10375098145235381 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.884194229483362e-15, - "rotation_deg": 1.0842632933293532e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 12805, - "frame_counter_j": 15094, - "rtk_translation_m": 3.5240348999326185, - "rtk_rotation_deg": 22.39089624755224, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9255107551713521, - -0.3764578612653224, - -0.0413439324894626, - -1.7034047301879027 - ], - [ - 0.37755998998954116, - 0.9257009217420918, - 0.022940301762172252, - 3.6393035793561026 - ], - [ - 0.029636059475769874, - -0.03684131074461654, - 0.9988815854751586, - -0.027040447434198877 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6988, - "backend_objective": 98.73024037425444, - "backend_elapsed_sec": 0.6462736999965273, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8744488767583456, - "inlier_rmse_m": 0.3953535087664721, - "target_points": 4484, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7513266691348883, - "inlier_rmse_m": 0.1932780854547344, - "target_points": 7969, - "source_points": 8103 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.630060409340907, - "inlier_rmse_m": 0.11886353691713382, - "target_points": 11169, - "source_points": 11091 - } - ], - "heldout_symmetric": { - "evaluated": 7711, - "inliers": 5313, - "inlier_ratio": 0.6890156918687589, - "inlier_rmse_m": 0.11084024896736888, - "median_m": 0.12444471284166714, - "p90_m": 1.0390302475893212, - "p95_m": 1.5254214437610027 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3274.5589283480967, - 4881.48997954115, - 5553.592693208326, - 6987.999999999999, - 11825.629543059533, - 14477.372229978067 - ], - "effective_rank": 6, - "scaled_condition_number": 4.42116710884217, - "weakest_scaled_direction": [ - 0.10091257103004869, - -0.919158164984943, - 0.01859955054417381, - 0.15176870935163217, - 0.02370197232904839, - 0.3478842520704622 - ] - }, - "forward_reverse": { - "translation_m": 0.01556225520371614, - "rotation_deg": 0.02495881796886513 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.248030287623391e-15, - "rotation_deg": 5.4937892537477076e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 12805, - "frame_counter_j": 15761, - "rtk_translation_m": 2.146829294717985, - "rtk_rotation_deg": 30.035090485266103, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8685691360844355, - 0.4955592087805267, - -0.002954053885128903, - 0.4401388911120535 - ], - [ - -0.495546354040226, - 0.8684600126783903, - -0.014526437143691045, - 1.4152669373937818 - ], - [ - -0.004633232022795894, - 0.014081085592694576, - 0.9998901220581956, - 0.037017503105767596 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8891, - "backend_objective": 114.86952188432954, - "backend_elapsed_sec": 0.7988309000211302, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.978331780055918, - "inlier_rmse_m": 0.287425493312726, - "target_points": 4484, - "source_points": 4292 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9339195654985128, - "inlier_rmse_m": 0.1810239276670827, - "target_points": 7969, - "source_points": 7733 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8211877713124596, - "inlier_rmse_m": 0.11366509037828647, - "target_points": 11169, - "source_points": 10827 - } - ], - "heldout_symmetric": { - "evaluated": 8046, - "inliers": 6988, - "inlier_ratio": 0.8685060899826, - "inlier_rmse_m": 0.10135543575024519, - "median_m": 0.07770756094194906, - "p90_m": 0.29270140371814013, - "p95_m": 0.45015599359162717 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4189.031240146661, - 5763.022749834576, - 7791.130024000946, - 8890.999999999998, - 10152.832628687886, - 12232.273807529693 - ], - "effective_rank": 6, - "scaled_condition_number": 2.92007223300188, - "weakest_scaled_direction": [ - -0.2009746556512417, - -0.9576645420155571, - -0.012655654035825718, - 0.1329295172494467, - -0.029933548655592973, - 0.1541472454558819 - ] - }, - "forward_reverse": { - "translation_m": 0.002952251383831446, - "rotation_deg": 0.02753369989560042 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2538083914528953e-15, - "rotation_deg": 2.916263518797617e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 14288, - "frame_counter_j": 15094, - "rtk_translation_m": 2.640403049812329, - "rtk_rotation_deg": 27.891408321361506, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8823097529107611, - 0.4706687989097939, - -0.0006177793809696017, - 2.499302483644158 - ], - [ - -0.47061942638952536, - 0.8821965909878098, - -0.015701285115615398, - -0.5177217283241621 - ], - [ - -0.006845102142832981, - 0.014144135968647229, - 0.9998765363755441, - 0.07309812657669451 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8535, - "backend_objective": 107.39490738315509, - "backend_elapsed_sec": 0.6916152000194415, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.942053327734621, - "inlier_rmse_m": 0.3099607212229133, - "target_points": 4768, - "source_points": 4763 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8727631741330372, - "inlier_rmse_m": 0.1727315632398436, - "target_points": 8182, - "source_points": 8103 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7695428725994049, - "inlier_rmse_m": 0.11217345102387269, - "target_points": 11682, - "source_points": 11091 - } - ], - "heldout_symmetric": { - "evaluated": 7549, - "inliers": 5811, - "inlier_ratio": 0.7697708305735859, - "inlier_rmse_m": 0.10648049893472207, - "median_m": 0.09912948311211761, - "p90_m": 0.6555595514533777, - "p95_m": 1.192114499552214 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3925.265132527117, - 7516.404611640881, - 8535.0, - 8788.494326388503, - 10592.053298946774, - 14887.833349654953 - ], - "effective_rank": 6, - "scaled_condition_number": 3.7928223564531667, - "weakest_scaled_direction": [ - 0.7950162434941211, - 0.44449821669285194, - 0.006833768980654472, - -0.07787935626043158, - 0.13340898895924408, - 0.38270178347144224 - ] - }, - "forward_reverse": { - "translation_m": 0.010582276181446382, - "rotation_deg": 0.039599051949106026 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.679671031938356e-15, - "rotation_deg": 1.9025066530668517e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 14288, - "frame_counter_j": 15761, - "rtk_translation_m": 3.933985934417215, - "rtk_rotation_deg": 80.31739505417984, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.17422973322544114, - 0.984675015926918, - -0.007688502423202648, - 2.155375638318386 - ], - [ - -0.9824659879480963, - 0.17330202942790318, - -0.06875310263064516, - -3.5856091901133955 - ], - [ - -0.06636702935465323, - 0.019532526858811804, - 0.997604078685099, - -0.019951652785153075 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6803, - "backend_objective": 95.28408937589002, - "backend_elapsed_sec": 1.2986045999859925, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8664958061509785, - "inlier_rmse_m": 0.4133444254263843, - "target_points": 4768, - "source_points": 4292 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7292124660545714, - "inlier_rmse_m": 0.18943921711927933, - "target_points": 8182, - "source_points": 7733 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6283365659924264, - "inlier_rmse_m": 0.11834773713338825, - "target_points": 11682, - "source_points": 10827 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 4962, - "inlier_ratio": 0.6293759512937596, - "inlier_rmse_m": 0.1095449771750205, - "median_m": 0.14106555301981444, - "p90_m": 1.1967793115577627, - "p95_m": 1.7002376870465155 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3198.8238253230834, - 5762.577755613054, - 6802.999999999999, - 7031.384366051658, - 7933.960852513379, - 11670.291127834229 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6483069293931876, - "weakest_scaled_direction": [ - 0.6771581918327142, - 0.5493023358854363, - 0.042156071186760874, - -0.09924876321587665, - 0.08630045490067013, - 0.4697323782440437 - ] - }, - "forward_reverse": { - "translation_m": 0.012240937390583118, - "rotation_deg": 0.060306184678878015 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1706208825930276e-15, - "rotation_deg": 1.8850753635475668e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 14288, - "frame_counter_j": 16475, - "rtk_translation_m": 4.2254212089887, - "rtk_rotation_deg": 152.98392843416656, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8869705848521764, - 0.4597345174894001, - -0.043901651857027074, - -5.8571420547617326 - ], - [ - -0.4581824230707041, - -0.8879053158145812, - -0.041146291901777106, - -3.0951489672874106 - ], - [ - -0.05789688071083702, - -0.016380585367958427, - 0.998188172453951, - -0.16042162889902042 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6607, - "backend_objective": 108.34420580700518, - "backend_elapsed_sec": 1.0603649000113364, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8320102982192662, - "inlier_rmse_m": 0.40517186021201346, - "target_points": 4768, - "source_points": 4661 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7169148807361666, - "inlier_rmse_m": 0.20417332623539375, - "target_points": 8182, - "source_points": 8259 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5860386730530424, - "inlier_rmse_m": 0.12805622405765335, - "target_points": 11682, - "source_points": 11274 - } - ], - "heldout_symmetric": { - "evaluated": 7713, - "inliers": 4639, - "inlier_ratio": 0.6014520938674964, - "inlier_rmse_m": 0.12300562605352797, - "median_m": 0.1704626644034497, - "p90_m": 1.3821907492869663, - "p95_m": 2.127673607543134 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2693.9673037014763, - 3793.879603747591, - 4645.3080880378075, - 6606.999999999999, - 10838.27374688087, - 12714.036948577783 - ], - "effective_rank": 6, - "scaled_condition_number": 4.719447385686107, - "weakest_scaled_direction": [ - 0.8781087681279518, - 0.31065403159669563, - 0.0653600879378438, - -0.07650136088755265, - 0.1497531467477941, - 0.31602003056099687 - ] - }, - "forward_reverse": { - "translation_m": 1.3272837904090529, - "rotation_deg": 0.4474442011368189 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.577266891415849e-09, - "rotation_deg": 1.6959092001245427e-07 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 15094, - "frame_counter_j": 15761, - "rtk_translation_m": 2.4460967931915643, - "rtk_rotation_deg": 52.425986732818345, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6167485120774459, - 0.7869701239379373, - 0.017300198824402858, - 1.1466033020612907 - ], - [ - -0.7855738017200135, - 0.6167514879407058, - -0.04991396772537581, - -2.8682149819924376 - ], - [ - -0.04995072473369378, - 0.017193782365508954, - 0.9986036746109772, - -0.05778139705360087 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7134, - "backend_objective": 99.4292817382692, - "backend_elapsed_sec": 1.2040562000183854, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8995806150978565, - "inlier_rmse_m": 0.3762845022246815, - "target_points": 4763, - "source_points": 4292 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7819733609207293, - "inlier_rmse_m": 0.18703209238282328, - "target_points": 8103, - "source_points": 7733 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.658908284843447, - "inlier_rmse_m": 0.11805668891166524, - "target_points": 11091, - "source_points": 10827 - } - ], - "heldout_symmetric": { - "evaluated": 7615, - "inliers": 5199, - "inlier_ratio": 0.6827314510833881, - "inlier_rmse_m": 0.10834806615100012, - "median_m": 0.12048357327824945, - "p90_m": 0.9656513916057085, - "p95_m": 1.504659838869031 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3057.2817621505988, - 5879.408871943106, - 6772.003892718104, - 7133.999999999998, - 8396.035776290852, - 10723.066543061193 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5073857685652805, - "weakest_scaled_direction": [ - 0.4864128078879415, - 0.8321952906595489, - 0.04553803203296789, - -0.12311818357684112, - 0.059719165412243376, - 0.2237306423367302 - ] - }, - "forward_reverse": { - "translation_m": 0.012418496053917759, - "rotation_deg": 0.11905018881098527 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.597186369366252e-15, - "rotation_deg": 8.491408279333536e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 15094, - "frame_counter_j": 16475, - "rtk_translation_m": 6.593931011285688, - "rtk_rotation_deg": 125.09252011280485, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5665187276244886, - 0.8235083028600456, - -0.02984302885596281, - -6.149031223904052 - ], - [ - -0.8222822909141003, - -0.5673034818093925, - -0.04492876112250384, - -6.2084212543412605 - ], - [ - -0.05392926199932333, - -0.0009135904493687485, - 0.9985443405541373, - -0.21105802140089383 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6031, - "backend_objective": 101.72544032171504, - "backend_elapsed_sec": 1.6184766000078525, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8105556747479081, - "inlier_rmse_m": 0.42978163970081584, - "target_points": 4763, - "source_points": 4661 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.6690882673447148, - "inlier_rmse_m": 0.21023759782359572, - "target_points": 8103, - "source_points": 8259 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5349476671988647, - "inlier_rmse_m": 0.12987337450133224, - "target_points": 11091, - "source_points": 11274 - } - ], - "heldout_symmetric": { - "evaluated": 7444, - "inliers": 4285, - "inlier_ratio": 0.5756313809779688, - "inlier_rmse_m": 0.1265759478434112, - "median_m": 0.18860727280502898, - "p90_m": 1.5687308923452958, - "p95_m": 2.4062732751652387 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2442.606361044983, - 2838.1067656928235, - 3633.5068753501264, - 6030.999999999998, - 11508.37951917188, - 13163.438072053988 - ], - "effective_rank": 6, - "scaled_condition_number": 5.389095141151797, - "weakest_scaled_direction": [ - -0.40503394867337683, - -0.8574718824605979, - -0.0840287624243686, - 0.1733613810832198, - -0.10438065274380742, - 0.2295193873699019 - ] - }, - "forward_reverse": { - "translation_m": 0.012917057356045326, - "rotation_deg": 0.24042373011343365 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.332644630809016e-15, - "rotation_deg": 1.9123702764380883e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 15094, - "frame_counter_j": 17193, - "rtk_translation_m": 11.793089868757727, - "rtk_rotation_deg": 175.70238585456048, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.99549917434554, - 0.07835894174384257, - -0.05330356579192146, - -11.436192121198863 - ], - [ - -0.0771774577151193, - -0.9967314249010301, - -0.023876905900745996, - -7.920924273201596 - ], - [ - -0.05500030816258748, - -0.01965560641514769, - 0.9982928544462653, - -0.4091353934747035 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4724, - "backend_objective": 99.80965730760222, - "backend_elapsed_sec": 0.9836230000073556, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7331449333871619, - "inlier_rmse_m": 0.46898515701750715, - "target_points": 4763, - "source_points": 4954 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5689108212900952, - "inlier_rmse_m": 0.24011717811992545, - "target_points": 8103, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.39524765729585004, - "inlier_rmse_m": 0.1453554559514444, - "target_points": 11091, - "source_points": 11952 - } - ], - "heldout_symmetric": { - "evaluated": 7682, - "inliers": 3107, - "inlier_ratio": 0.4044519656339495, - "inlier_rmse_m": 0.14396876383759685, - "median_m": 0.3455490401115615, - "p90_m": 1.9799679700993877, - "p95_m": 3.158641944126311 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1498.1927272478185, - 1982.6511813688023, - 2425.384370696985, - 4723.999999999999, - 13345.052830383827, - 15044.305038721111 - ], - "effective_rank": 6, - "scaled_condition_number": 10.041635341774429, - "weakest_scaled_direction": [ - -0.25022099172136136, - 0.4827992671208817, - 0.019326645940768324, - -0.0774183565482994, - -0.006682571703724073, - -0.8353936467504306 - ] - }, - "forward_reverse": { - "translation_m": 0.06610149517267662, - "rotation_deg": 0.6118050873537593 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0087767680389479e-14, - "rotation_deg": 4.718792105850687e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 15761, - "frame_counter_j": 16475, - "rtk_translation_m": 6.650720121741557, - "rtk_rotation_deg": 72.6665333799865, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2995632277602407, - 0.9534722095606621, - -0.033950230770582464, - -1.8673778110282038 - ], - [ - -0.9538893808486062, - 0.29861017484298136, - -0.030446881359301927, - -7.806720776704809 - ], - [ - -0.018892370897521726, - 0.0415055306646438, - 0.9989596434521851, - -0.11514784259866731 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6449, - "backend_objective": 112.62390511032423, - "backend_elapsed_sec": 0.7281959999818355, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8513194593434885, - "inlier_rmse_m": 0.40697865916910336, - "target_points": 4292, - "source_points": 4661 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7267223634822618, - "inlier_rmse_m": 0.21469325083875807, - "target_points": 7733, - "source_points": 8259 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.57202412630832, - "inlier_rmse_m": 0.13215058880776795, - "target_points": 10827, - "source_points": 11274 - } - ], - "heldout_symmetric": { - "evaluated": 7779, - "inliers": 4850, - "inlier_ratio": 0.6234734541714874, - "inlier_rmse_m": 0.12775305804057488, - "median_m": 0.170675977245648, - "p90_m": 0.9935771645608374, - "p95_m": 1.649768573465828 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2392.0979050100423, - 3933.0839725032315, - 4319.562385462285, - 6448.999999999998, - 11952.794904028282, - 14253.563652472267 - ], - "effective_rank": 6, - "scaled_condition_number": 5.958603794025073, - "weakest_scaled_direction": [ - -0.3292130085735028, - 0.7456663668521551, - 0.017389508926355515, - -0.09447317865484572, - -0.028403619141021665, - -0.5705840185681088 - ] - }, - "forward_reverse": { - "translation_m": 0.009237066767190358, - "rotation_deg": 0.22540488888099894 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.220446049250313e-16, - "rotation_deg": 5.063229629354439e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 15761, - "frame_counter_j": 17193, - "rtk_translation_m": 12.053580264031138, - "rtk_rotation_deg": 123.27639912174077, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.549352576208667, - 0.8324274319077399, - -0.07263826553811113, - -3.7596232350865906 - ], - [ - -0.832162592796407, - -0.5528939831444903, - -0.04258711721849981, - -13.00346265213859 - ], - [ - -0.0756119445806231, - 0.037051504829145085, - 0.9964487040618965, - -0.38373689816394135 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 4278, - "backend_objective": 93.73943185262516, - "backend_elapsed_sec": 1.2945770999940578, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7490916431166734, - "inlier_rmse_m": 0.48850887093859957, - "target_points": 4292, - "source_points": 4954 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.5576313006697216, - "inlier_rmse_m": 0.24703292869390212, - "target_points": 7733, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.35793172690763053, - "inlier_rmse_m": 0.1480269423285001, - "target_points": 10827, - "source_points": 11952 - } - ], - "heldout_symmetric": { - "evaluated": 8017, - "inliers": 3037, - "inlier_ratio": 0.3788200074840963, - "inlier_rmse_m": 0.14687803396129923, - "median_m": 0.3931050233043033, - "p90_m": 1.8929340554927732, - "p95_m": 2.8623032606456804 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 1275.0791106173986, - 2002.9938343049378, - 2493.689261069071, - 4278.000000000002, - 11351.57572713189, - 12967.64327828981 - ], - "effective_rank": 6, - "scaled_condition_number": 10.170069582593054, - "weakest_scaled_direction": [ - 0.4290773039236958, - -0.5121957049948269, - -0.009551514731244548, - 0.06761011787950263, - 0.04284572421015728, - 0.7396283603851259 - ] - }, - "forward_reverse": { - "translation_m": 0.1645149893124099, - "rotation_deg": 1.1204113986936788 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.124706989126661e-15, - "rotation_deg": 2.2750614619856374e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 15761, - "frame_counter_j": 18005, - "rtk_translation_m": 14.836246959975925, - "rtk_rotation_deg": 128.85294276465592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6303671391936169, - 0.7728165394038959, - -0.07342932825951184, - -5.026462229397824 - ], - [ - -0.7726674450137104, - -0.6337429420472728, - -0.036809004621847004, - -15.55395683155031 - ], - [ - -0.07498192609449582, - 0.03353326451531177, - 0.9966209063280314, - -0.4350657660332013 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 3737, - "backend_objective": 86.44641468672715, - "backend_elapsed_sec": 0.9636042999918573, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.7094861660079052, - "inlier_rmse_m": 0.5227833742371985, - "target_points": 4292, - "source_points": 5060 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.4972407449988503, - "inlier_rmse_m": 0.25874220502437517, - "target_points": 7733, - "source_points": 8698 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.30548516308346274, - "inlier_rmse_m": 0.15209395175246385, - "target_points": 10827, - "source_points": 12233 - } - ], - "heldout_symmetric": { - "evaluated": 8130, - "inliers": 2614, - "inlier_ratio": 0.3215252152521525, - "inlier_rmse_m": 0.1505833656059155, - "median_m": 0.5018519231305192, - "p90_m": 2.3960338427586945, - "p95_m": 4.24609726397105 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 869.399108894314, - 1384.0443740461421, - 2202.0687185471406, - 3737.000000000001, - 11669.588540978859, - 13261.903080751388 - ], - "effective_rank": 6, - "scaled_condition_number": 15.25410245430046, - "weakest_scaled_direction": [ - -0.46408136775125053, - 0.28403739646339166, - -0.012190367884641659, - -0.01154261431638178, - -0.05478423592358029, - -0.8370591926478537 - ] - }, - "forward_reverse": { - "translation_m": 0.08605091089946505, - "rotation_deg": 0.48945936193054473 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2260803654376782e-14, - "rotation_deg": 2.887811979748576e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation" - ] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 16475, - "frame_counter_j": 17193, - "rtk_translation_m": 5.40286046809103, - "rtk_rotation_deg": 50.60986574175429, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6303430954662553, - 0.7763163468823693, - 0.000715235089905373, - 4.400478318247196 - ], - [ - -0.7760613002584296, - 0.6301591009886105, - -0.025067223269118456, - -3.3790045559096997 - ], - [ - -0.019910807096017058, - 0.015245884836337513, - 0.9996855119267958, - 0.08410976933572639 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7439, - "backend_objective": 123.23293244918672, - "backend_elapsed_sec": 1.3065648999763653, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9077513120710536, - "inlier_rmse_m": 0.39742858583776913, - "target_points": 4661, - "source_points": 4954 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.767477382211256, - "inlier_rmse_m": 0.20313140621393325, - "target_points": 8259, - "source_points": 8511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6224062918340026, - "inlier_rmse_m": 0.1287081690276773, - "target_points": 11274, - "source_points": 11952 - } - ], - "heldout_symmetric": { - "evaluated": 7846, - "inliers": 5176, - "inlier_ratio": 0.6596992097884272, - "inlier_rmse_m": 0.12147955429086157, - "median_m": 0.1495751460506765, - "p90_m": 0.9309708721622469, - "p95_m": 1.454348790151935 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3528.592015680104, - 4139.388136318804, - 5354.508591886923, - 7439.000000000002, - 12075.96032696083, - 14403.82811983698 - ], - "effective_rank": 6, - "scaled_condition_number": 4.0820327359553845, - "weakest_scaled_direction": [ - 0.8074375912931642, - -0.5139661399081521, - -0.0530281056863949, - 0.10856962141650259, - 0.18941922121160437, - -0.1827685945204652 - ] - }, - "forward_reverse": { - "translation_m": 0.014725537493637062, - "rotation_deg": 0.1988422472286775 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7136679897814678e-15, - "rotation_deg": 2.1308218036793923e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 16475, - "frame_counter_j": 18005, - "rtk_translation_m": 8.200956565000565, - "rtk_rotation_deg": 56.18640938466938, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5498976142694335, - 0.8351802349875066, - -0.009305316061222561, - 6.445134051540377 - ], - [ - -0.8349275207571369, - 0.5493621558219541, - -0.03312486729023366, - -5.339854544480168 - ], - [ - -0.02255324595538929, - 0.025984549964749144, - 0.9994079018398869, - 0.09419631258178547 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 6708, - "backend_objective": 127.48572540041903, - "backend_elapsed_sec": 1.3334451999980956, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8693675889328063, - "inlier_rmse_m": 0.4243871153600972, - "target_points": 4661, - "source_points": 5060 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7183260519659692, - "inlier_rmse_m": 0.22005739628648716, - "target_points": 8259, - "source_points": 8698 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5483528161530287, - "inlier_rmse_m": 0.13785872347698166, - "target_points": 11274, - "source_points": 12233 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 4568, - "inlier_ratio": 0.5739414499308958, - "inlier_rmse_m": 0.13255415786946786, - "median_m": 0.19925572732689953, - "p90_m": 1.1603230526808797, - "p95_m": 1.6823692816118718 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2917.3968485220435, - 3591.5140230503885, - 4290.69600811845, - 6708.000000000001, - 13063.411638112144, - 15545.309259653664 - ], - "effective_rank": 6, - "scaled_condition_number": 5.328486341352201, - "weakest_scaled_direction": [ - -0.5413503273696024, - -0.38763268014281005, - 0.005638313230374644, - 0.064746601508778, - -0.10113294193278008, - -0.7363619649432789 - ] - }, - "forward_reverse": { - "translation_m": 0.006040617548520927, - "rotation_deg": 0.19706632354687328 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5135275191586602e-15, - "rotation_deg": 1.4635076473294652e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 16475, - "frame_counter_j": 18949, - "rtk_translation_m": 5.175118275082073, - "rtk_rotation_deg": 70.79178325235415, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.322507751768782, - 0.9465658690795198, - 0.001343704870134349, - 4.202327810778941 - ], - [ - -0.9461440127230181, - 0.32240579445474693, - -0.029428062973761566, - -2.321475152586436 - ], - [ - -0.028288818240253918, - 0.008219440110833596, - 0.9995659976043778, - 0.09104259227548182 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7248, - "backend_objective": 119.80416666881655, - "backend_elapsed_sec": 1.7686648000089917, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.906938097216452, - "inlier_rmse_m": 0.39176375407198155, - "target_points": 4661, - "source_points": 4814 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7707491082045185, - "inlier_rmse_m": 0.20302011752598614, - "target_points": 8259, - "source_points": 8410 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6210796915167095, - "inlier_rmse_m": 0.1285662181261835, - "target_points": 11274, - "source_points": 11670 - } - ], - "heldout_symmetric": { - "evaluated": 7804, - "inliers": 5039, - "inlier_ratio": 0.6456945156330087, - "inlier_rmse_m": 0.12075756038041646, - "median_m": 0.15517808632435381, - "p90_m": 0.9630093745757822, - "p95_m": 1.4799107242665825 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3466.4899820586243, - 4396.442579998249, - 5558.437964204887, - 7248.0000000000055, - 11430.044722171817, - 13742.10326409042 - ], - "effective_rank": 6, - "scaled_condition_number": 3.9642702950866386, - "weakest_scaled_direction": [ - 0.9258200373589631, - -0.3108992166063795, - -0.04310100409991908, - 0.06721098854473163, - 0.19950586836742343, - 0.004618494296501815 - ] - }, - "forward_reverse": { - "translation_m": 0.022949011013485506, - "rotation_deg": 0.1911210947924365 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.6022276260193494e-15, - "rotation_deg": 3.128640029315481e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 17193, - "frame_counter_j": 18005, - "rtk_translation_m": 2.8644847627909416, - "rtk_rotation_deg": 5.57654364291509, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9949972956120353, - 0.09990184864129793, - -4.8608500267821146e-05, - 2.8127749298304954 - ], - [ - -0.09989439805410004, - 0.9949169070895627, - -0.012706581945846273, - 0.35417323668457684 - ], - [ - -0.0012210496075574604, - 0.012647870389464322, - 0.9999192669473208, - 0.0866365210746691 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9088, - "backend_objective": 132.81604313146903, - "backend_elapsed_sec": 0.6644989000051282, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9349802371541502, - "inlier_rmse_m": 0.3290850481749256, - "target_points": 4954, - "source_points": 5060 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8523798574384917, - "inlier_rmse_m": 0.18222493777602602, - "target_points": 8511, - "source_points": 8698 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7429085261178778, - "inlier_rmse_m": 0.12089020376233393, - "target_points": 11952, - "source_points": 12233 - } - ], - "heldout_symmetric": { - "evaluated": 8197, - "inliers": 6325, - "inlier_ratio": 0.7716237647919971, - "inlier_rmse_m": 0.11632271358541554, - "median_m": 0.12061523540880016, - "p90_m": 0.5638942930862972, - "p95_m": 0.9564969126200213 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5238.37066645052, - 5960.064716796541, - 8021.911791991109, - 9088.0, - 11435.758522287948, - 14647.540073960481 - ], - "effective_rank": 6, - "scaled_condition_number": 2.79620153032919, - "weakest_scaled_direction": [ - 0.8286342274350785, - 0.49208481699362094, - -0.02217314675461189, - -0.123836994562774, - 0.20318015752027077, - -0.11877888675232023 - ] - }, - "forward_reverse": { - "translation_m": 0.00996357879827298, - "rotation_deg": 0.15332892195322273 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7510776865858688e-15, - "rotation_deg": 7.420933165871709e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 17193, - "frame_counter_j": 18949, - "rtk_translation_m": 1.2936223973175418, - "rtk_rotation_deg": 20.18191751059984, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9381092216024289, - 0.34632655331207624, - 0.0030011356954492987, - -0.9422024826829761 - ], - [ - -0.34632017473392956, - 0.9381131769077653, - -0.0024502824900267768, - 0.515992791791233 - ], - [ - -0.0036640028310011433, - 0.0012592787609768446, - 0.9999924946219629, - -0.009944132153914738 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9972, - "backend_objective": 106.82287065511204, - "backend_elapsed_sec": 0.6348317000083625, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9646863315330286, - "inlier_rmse_m": 0.24999147110283615, - "target_points": 4954, - "source_points": 4814 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9195005945303211, - "inlier_rmse_m": 0.1427462580205043, - "target_points": 8511, - "source_points": 8410 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8544987146529563, - "inlier_rmse_m": 0.10350015194955625, - "target_points": 11952, - "source_points": 11670 - } - ], - "heldout_symmetric": { - "evaluated": 8042, - "inliers": 6897, - "inlier_ratio": 0.8576224819696593, - "inlier_rmse_m": 0.09865676260631216, - "median_m": 0.07977168507318846, - "p90_m": 0.3447592239536294, - "p95_m": 0.6965109995195521 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5559.002239993305, - 9325.061412631727, - 9971.999999999996, - 10357.32506975672, - 11703.404533222978, - 16881.550593109147 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0367950693845156, - "weakest_scaled_direction": [ - 0.8351103871037826, - 0.4644264067889887, - 0.010511603766962255, - -0.09979123030130622, - 0.1841294041958525, - -0.2071867106744967 - ] - }, - "forward_reverse": { - "translation_m": 0.0039225733250952055, - "rotation_deg": 0.00898487649368532 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.928739733030706e-15, - "rotation_deg": 9.754520833874925e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 17193, - "frame_counter_j": 20284, - "rtk_translation_m": 2.3128500583741403, - "rtk_rotation_deg": 54.59467208208593, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5863730584616764, - 0.8099641014896077, - -0.011170971686977796, - -2.421809924402417 - ], - [ - -0.8100055163174597, - 0.5864208373587476, - 0.001290366905073347, - 0.26796640817623507 - ], - [ - 0.007596041441648036, - 0.008291912300412598, - 0.9999367701734039, - -0.0513564309653848 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8408, - "backend_objective": 117.95373727230279, - "backend_elapsed_sec": 0.6464260000211652, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9229920564872022, - "inlier_rmse_m": 0.30096650011851994, - "target_points": 4954, - "source_points": 4532 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8612687602471939, - "inlier_rmse_m": 0.18275950030949215, - "target_points": 8511, - "source_points": 7929 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7487088156723063, - "inlier_rmse_m": 0.11844302792873286, - "target_points": 11952, - "source_points": 11230 - } - ], - "heldout_symmetric": { - "evaluated": 7942, - "inliers": 6128, - "inlier_ratio": 0.7715940569126165, - "inlier_rmse_m": 0.1136150455355286, - "median_m": 0.11068266325131845, - "p90_m": 0.5562501070241405, - "p95_m": 0.9765350057138606 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3943.2395918814473, - 5840.17737729365, - 7904.515121732507, - 8408.000000000002, - 9025.709822314915, - 10915.5112053645 - ], - "effective_rank": 6, - "scaled_condition_number": 2.76815824933335, - "weakest_scaled_direction": [ - 0.967272607196293, - 0.10078787723861277, - 0.018708924279614902, - -0.011742744776234278, - 0.14610462941086985, - -0.179975077528952 - ] - }, - "forward_reverse": { - "translation_m": 0.007475673605589086, - "rotation_deg": 0.042277690012993266 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.265048141851813e-15, - "rotation_deg": 4.275608813106499e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 18005, - "frame_counter_j": 18949, - "rtk_translation_m": 3.7194009250537223, - "rtk_rotation_deg": 14.605373867684753, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9680444196649723, - 0.2507479695178774, - 0.003931582145739447, - -3.7524322146059594 - ], - [ - -0.25077356071372225, - 0.9680065077186712, - 0.008719074564636421, - -0.21052314536215322 - ], - [ - -0.0016195068595487717, - -0.009426388330864661, - 0.9999542591541715, - -0.09061951809113535 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8425, - "backend_objective": 119.72122314170635, - "backend_elapsed_sec": 0.6111849000153597, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9266722060656418, - "inlier_rmse_m": 0.3326566134982575, - "target_points": 5060, - "source_points": 4814 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8407847800237812, - "inlier_rmse_m": 0.18437645905040922, - "target_points": 8698, - "source_points": 8410 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.721936589545844, - "inlier_rmse_m": 0.1192066868963147, - "target_points": 12233, - "source_points": 11670 - } - ], - "heldout_symmetric": { - "evaluated": 8155, - "inliers": 6032, - "inlier_ratio": 0.7396689147762109, - "inlier_rmse_m": 0.11702962848624102, - "median_m": 0.12428186412933284, - "p90_m": 0.6834731153650483, - "p95_m": 1.133267609835889 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3956.8261444779464, - 6284.256934054239, - 7344.820627755349, - 8425.0, - 10329.717320870912, - 13511.788614518624 - ], - "effective_rank": 6, - "scaled_condition_number": 3.4148047250889095, - "weakest_scaled_direction": [ - 0.710998161995777, - 0.5253069794287105, - 0.0274124906871681, - -0.07097001746005022, - 0.11930755637458898, - -0.44554652952310314 - ] - }, - "forward_reverse": { - "translation_m": 0.01814015943430581, - "rotation_deg": 0.11847321816106485 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.510691584075473e-16, - "rotation_deg": 1.6855623830025184e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 18005, - "frame_counter_j": 20284, - "rtk_translation_m": 4.786117710081478, - "rtk_rotation_deg": 49.01812843917083, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6642709142929756, - 0.7473967745444093, - -0.01192534381002899, - -5.197706811864901 - ], - [ - -0.7473119732517021, - 0.6643765226744874, - 0.011342431556021179, - -0.6064792565804605 - ], - [ - 0.01640021521266574, - 0.0013775048343540525, - 0.9998645585385099, - -0.12492443806194173 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7597, - "backend_objective": 113.53567725166101, - "backend_elapsed_sec": 0.6267760999908205, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8921006178287731, - "inlier_rmse_m": 0.3601989247309637, - "target_points": 5060, - "source_points": 4532 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7992180602850296, - "inlier_rmse_m": 0.1946597876180889, - "target_points": 8698, - "source_points": 7929 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6764915405164738, - "inlier_rmse_m": 0.12224894341603466, - "target_points": 12233, - "source_points": 11230 - } - ], - "heldout_symmetric": { - "evaluated": 8055, - "inliers": 5625, - "inlier_ratio": 0.6983240223463687, - "inlier_rmse_m": 0.11898873157361621, - "median_m": 0.1349761973175614, - "p90_m": 0.8567080075359359, - "p95_m": 1.402633720953992 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3486.4343522393056, - 5145.593786430631, - 6124.867060747422, - 7597.000000000004, - 10069.500868055016, - 12667.839263508427 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6334655936865663, - "weakest_scaled_direction": [ - 0.6862262665104412, - 0.5531653158573244, - 0.025217313176956746, - -0.06777062094346989, - 0.1048078471313645, - -0.4548496341829549 - ] - }, - "forward_reverse": { - "translation_m": 0.013438931050857202, - "rotation_deg": 0.08244161259412694 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.535363269142996e-16, - "rotation_deg": 8.919903096252997e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 18005, - "frame_counter_j": 21049, - "rtk_translation_m": 2.3747421598149763, - "rtk_rotation_deg": 12.391903814042255, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9770407627777469, - 0.2079734083134367, - -0.04624293789510875, - 0.6795390786788823 - ], - [ - -0.20557320732701825, - 0.9772723215711487, - 0.05175389763313423, - -2.525725593055563 - ], - [ - 0.055955377757290994, - -0.04105935856087716, - 0.997588655095178, - 0.14917236666474296 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8885, - "backend_objective": 128.16450937721874, - "backend_elapsed_sec": 1.1623841999971773, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8974719101123596, - "inlier_rmse_m": 0.3291845730037167, - "target_points": 5060, - "source_points": 4984 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8245857953887151, - "inlier_rmse_m": 0.17924134494338995, - "target_points": 8698, - "source_points": 8631 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7303139898076607, - "inlier_rmse_m": 0.12010336449443608, - "target_points": 12233, - "source_points": 12166 - } - ], - "heldout_symmetric": { - "evaluated": 8315, - "inliers": 6127, - "inlier_ratio": 0.736861094407697, - "inlier_rmse_m": 0.11586394710110075, - "median_m": 0.12060291351780755, - "p90_m": 0.9403605138825243, - "p95_m": 1.6150043046473455 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5628.530181648795, - 6882.220123450566, - 8885.0, - 9062.01442625923, - 9687.017031439289, - 13412.82712718181 - ], - "effective_rank": 6, - "scaled_condition_number": 2.383007054117407, - "weakest_scaled_direction": [ - -0.46783687640020843, - -0.8195028278974066, - -0.02148447765036452, - 0.2540225470615088, - -0.14893741670344002, - 0.1495739979355733 - ] - }, - "forward_reverse": { - "translation_m": 0.018559552524775386, - "rotation_deg": 0.0645260279790244 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.730402943239876e-15, - "rotation_deg": 1.9294059580880524e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 18949, - "frame_counter_j": 20284, - "rtk_translation_m": 1.0880644725336985, - "rtk_rotation_deg": 34.41275457148609, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8305838981930657, - 0.5567195338613541, - -0.013919363477141665, - -1.3014464997509991 - ], - [ - -0.5567640076417144, - 0.8306703286284975, - 0.0008030759370046185, - -0.7464624066983503 - ], - [ - 0.012009490295161249, - 0.007082778651052747, - 0.9999027984706466, - -0.04000695505509844 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8667, - "backend_objective": 123.8123286448374, - "backend_elapsed_sec": 0.6250815000094008, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9613857016769638, - "inlier_rmse_m": 0.29944414365003524, - "target_points": 4814, - "source_points": 4532 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9009963425400429, - "inlier_rmse_m": 0.189097482603213, - "target_points": 8410, - "source_points": 7929 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7717720391807658, - "inlier_rmse_m": 0.11952191631116695, - "target_points": 11670, - "source_points": 11230 - } - ], - "heldout_symmetric": { - "evaluated": 7900, - "inliers": 6204, - "inlier_ratio": 0.7853164556962026, - "inlier_rmse_m": 0.1128725442321241, - "median_m": 0.11066812001662685, - "p90_m": 0.481119677809975, - "p95_m": 0.7373502646771819 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4710.58152330169, - 6485.027623957997, - 8667.0, - 8779.515182045821, - 8941.749215378168, - 11352.13323956887 - ], - "effective_rank": 6, - "scaled_condition_number": 2.409921828847164, - "weakest_scaled_direction": [ - 0.7324147324638411, - 0.6553260418952908, - 0.01879746404287683, - -0.12138367722656418, - 0.13627631288929978, - -0.02139774001111644 - ] - }, - "forward_reverse": { - "translation_m": 0.002195759849115173, - "rotation_deg": 0.032112959181416705 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3910204087727232e-15, - "rotation_deg": 5.2286455112674205e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 18949, - "frame_counter_j": 21049, - "rtk_translation_m": 5.033935954106079, - "rtk_rotation_deg": 2.213470053642494, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9972203977900447, - -0.04367433413881774, - -0.06036580794617759, - 4.882979985646707 - ], - [ - 0.04541318230953327, - 0.9985830854679456, - 0.027739219344483403, - -1.113460366700672 - ], - [ - 0.059068782821258436, - -0.030403518790613045, - 0.9977908122152477, - 0.273657520138239 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7945, - "backend_objective": 130.14939780378864, - "backend_elapsed_sec": 1.1927686000126414, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8715890850722311, - "inlier_rmse_m": 0.3764516463880098, - "target_points": 4814, - "source_points": 4984 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7587765033020507, - "inlier_rmse_m": 0.19610674534834957, - "target_points": 8410, - "source_points": 8631 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6530494821634062, - "inlier_rmse_m": 0.1279894375970588, - "target_points": 11670, - "source_points": 12166 - } - ], - "heldout_symmetric": { - "evaluated": 8160, - "inliers": 5615, - "inlier_ratio": 0.6881127450980392, - "inlier_rmse_m": 0.12303206700403986, - "median_m": 0.14352944759097985, - "p90_m": 1.0073414204808202, - "p95_m": 1.8199687198569776 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4330.355563002327, - 5352.026756576795, - 6958.812549133235, - 7945.000000000004, - 9736.44276676571, - 12715.537950911366 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9363727218037994, - "weakest_scaled_direction": [ - 0.11838027757442754, - -0.8158692313483309, - -0.00249177828490221, - 0.1898261904027668, - 0.029169265485431965, - -0.5324025447438039 - ] - }, - "forward_reverse": { - "translation_m": 0.004939188019100004, - "rotation_deg": 0.12964064637100806 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1157603309187458e-15, - "rotation_deg": 6.4165896046035994e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 18949, - "frame_counter_j": 21808, - "rtk_translation_m": 5.765534437288107, - "rtk_rotation_deg": 40.730927532824346, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7595748228351848, - 0.6482450353218326, - -0.053145674287692256, - 5.459654421401187 - ], - [ - -0.6481308373964457, - 0.7612198406103922, - 0.021697278098228752, - -1.0601937250486408 - ], - [ - 0.05452069451758284, - 0.017964644212612884, - 0.9983510231514942, - 0.3040851537642928 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7771, - "backend_objective": 118.32974902645128, - "backend_elapsed_sec": 0.6451180999865755, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8612804878048781, - "inlier_rmse_m": 0.38777157788430494, - "target_points": 4814, - "source_points": 4592 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7545765194044423, - "inlier_rmse_m": 0.19772997398695177, - "target_points": 8410, - "source_points": 8194 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.648339729684632, - "inlier_rmse_m": 0.12339811262646998, - "target_points": 11670, - "source_points": 11986 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 5626, - "inlier_ratio": 0.6852618757612667, - "inlier_rmse_m": 0.12040544972155913, - "median_m": 0.13906209168376374, - "p90_m": 1.0169604186616972, - "p95_m": 1.9763620072269124 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4089.7416045296422, - 5138.4904664146525, - 6623.150406377983, - 7771.0, - 9672.724665170894, - 12510.546190010848 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0590065093977192, - "weakest_scaled_direction": [ - -0.21773801736288265, - 0.7872800707062773, - 0.0039290737338155265, - -0.17059126033879374, - -0.04991926550767124, - 0.5487909413158989 - ] - }, - "forward_reverse": { - "translation_m": 0.006032445250250899, - "rotation_deg": 0.14039335223024835 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.434197830121313e-15, - "rotation_deg": 1.698246585631573e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 20284, - "frame_counter_j": 21049, - "rtk_translation_m": 6.097212810998921, - "rtk_rotation_deg": 36.62622462512857, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8037633505035409, - -0.5928142183063497, - -0.050356518556728604, - 5.34155522383825 - ], - [ - 0.5936990913280177, - 0.8046802477837873, - 0.003329832264335108, - 3.1299436928178883 - ], - [ - 0.038546923918884125, - -0.03257301644696901, - 0.9987257547775252, - 0.17793036302987872 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7491, - "backend_objective": 122.36297219759622, - "backend_elapsed_sec": 0.8398709000030067, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8451043338683788, - "inlier_rmse_m": 0.40440965092986525, - "target_points": 4532, - "source_points": 4984 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.732591820183061, - "inlier_rmse_m": 0.20281369359927026, - "target_points": 7929, - "source_points": 8631 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6157323688969258, - "inlier_rmse_m": 0.127807138130654, - "target_points": 11230, - "source_points": 12166 - } - ], - "heldout_symmetric": { - "evaluated": 8060, - "inliers": 5462, - "inlier_ratio": 0.677667493796526, - "inlier_rmse_m": 0.12346315805814134, - "median_m": 0.1464769904195533, - "p90_m": 1.0425036798540477, - "p95_m": 1.8241663978789622 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3660.631064840855, - 4613.965978894759, - 5699.640371630539, - 7490.999999999998, - 10536.49658870688, - 13283.15782990778 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6286524357748307, - "weakest_scaled_direction": [ - 0.6563682646761972, - -0.3556356172765252, - -0.003869783403828985, - 0.060244745045807124, - 0.11828323901691135, - -0.6519729133090911 - ] - }, - "forward_reverse": { - "translation_m": 0.02347922689116974, - "rotation_deg": 0.16273859629352566 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.970890786799251e-15, - "rotation_deg": 1.1117016414937514e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 20284, - "frame_counter_j": 21808, - "rtk_translation_m": 6.852918693116795, - "rtk_rotation_deg": 6.318172961338249, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9924792517459847, - 0.11464079518805712, - -0.04292345433885335, - 5.793235167422612 - ], - [ - -0.1147577782487258, - 0.9933934684031152, - -0.00026318329094875066, - 3.5029465859448043 - ], - [ - 0.04260970763976171, - 0.0051870042103603, - 0.9990783291625216, - 0.21982586689000744 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7124, - "backend_objective": 121.5377324853921, - "backend_elapsed_sec": 1.1657464999880176, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8331881533101045, - "inlier_rmse_m": 0.41405807633433495, - "target_points": 4532, - "source_points": 4592 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7206492555528435, - "inlier_rmse_m": 0.2131216310219681, - "target_points": 7929, - "source_points": 8194 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.5943600867678959, - "inlier_rmse_m": 0.1306151667973528, - "target_points": 11230, - "source_points": 11986 - } - ], - "heldout_symmetric": { - "evaluated": 8110, - "inliers": 5296, - "inlier_ratio": 0.6530209617755857, - "inlier_rmse_m": 0.12710147612984257, - "median_m": 0.16093551712195867, - "p90_m": 1.136556474481721, - "p95_m": 2.0736986483914124 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3408.254021328904, - 4110.404962980765, - 5360.4964704143595, - 7124.000000000004, - 9795.973074773803, - 12041.995316044058 - ], - "effective_rank": 6, - "scaled_condition_number": 3.5331859775372005, - "weakest_scaled_direction": [ - 0.8047769771934876, - -0.06863997767047753, - -0.019562763050016686, - -0.0015254440932715278, - 0.14490268040145612, - -0.5711748900112381 - ] - }, - "forward_reverse": { - "translation_m": 0.013311199903818141, - "rotation_deg": 0.18193579850152686 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.8306605131362286e-15, - "rotation_deg": 1.1229881486757472e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 20284, - "frame_counter_j": 22445, - "rtk_translation_m": 7.47982907414204, - "rtk_rotation_deg": 31.60254826458195, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8472033387428138, - 0.5298056220988211, - -0.0394018478692232, - 6.137157336522583 - ], - [ - -0.530542787082115, - 0.8475914881862393, - -0.010631097280009903, - 3.304411515644586 - ], - [ - 0.02776425576473398, - 0.029911067294847195, - 0.999166890041455, - 0.2472402777703364 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7563, - "backend_objective": 120.2223714306218, - "backend_elapsed_sec": 0.7761194000195246, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.847083775185578, - "inlier_rmse_m": 0.3995558643998555, - "target_points": 4532, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7331007938417128, - "inlier_rmse_m": 0.19693761531375742, - "target_points": 7929, - "source_points": 8314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6304601533844615, - "inlier_rmse_m": 0.1260798243116474, - "target_points": 11230, - "source_points": 11996 - } - ], - "heldout_symmetric": { - "evaluated": 8120, - "inliers": 5399, - "inlier_ratio": 0.6649014778325123, - "inlier_rmse_m": 0.1248115961442785, - "median_m": 0.15506265295621713, - "p90_m": 1.1670237044609033, - "p95_m": 1.9789037080338905 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3399.509912540717, - 4808.494143252888, - 5652.355733740009, - 7563.0, - 10991.02906448226, - 13938.206713586194 - ], - "effective_rank": 6, - "scaled_condition_number": 4.10006355979974, - "weakest_scaled_direction": [ - 0.6336190232432726, - -0.3833423356919101, - -0.011825054853273481, - 0.057226122269047, - 0.11493195706920405, - -0.6595085831909395 - ] - }, - "forward_reverse": { - "translation_m": 0.017872821205486625, - "rotation_deg": 0.1680556511699705 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1314069507916044e-15, - "rotation_deg": 6.809027884116031e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 21049, - "frame_counter_j": 21808, - "rtk_translation_m": 1.2882746074869595, - "rtk_rotation_deg": 42.944397586466835, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.731376825723403, - 0.681972824686745, - 0.0010025884210163915, - 0.5934045670931157 - ], - [ - -0.681966395137421, - 0.7313750893872982, - -0.003509206034461014, - 0.03104477317046849 - ], - [ - -0.003126451347768677, - 0.0018828203590064386, - 0.9999933401225558, - 0.014299903296172183 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10692, - "backend_objective": 118.79558962502077, - "backend_elapsed_sec": 0.7246742999996059, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9867160278745645, - "inlier_rmse_m": 0.25413081389620407, - "target_points": 4984, - "source_points": 4592 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9538686844032219, - "inlier_rmse_m": 0.15693498741141237, - "target_points": 8631, - "source_points": 8194 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8920407141665276, - "inlier_rmse_m": 0.10540729869476612, - "target_points": 12166, - "source_points": 11986 - } - ], - "heldout_symmetric": { - "evaluated": 8370, - "inliers": 7640, - "inlier_ratio": 0.9127837514934289, - "inlier_rmse_m": 0.0958142916589384, - "median_m": 0.07452961120192095, - "p90_m": 0.23108824193102034, - "p95_m": 0.36282615590852785 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6569.756111954044, - 9497.76721223113, - 10692.0, - 11510.277228558976, - 12273.142000537238, - 19063.89404835365 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9017658682436953, - "weakest_scaled_direction": [ - 0.44312868623079144, - 0.7478136519772935, - -0.0005696502855167559, - -0.20908014531616242, - 0.12356569112011447, - -0.4306139775563361 - ] - }, - "forward_reverse": { - "translation_m": 0.003534148840172682, - "rotation_deg": 0.018440169300173608 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.496569158470144e-15, - "rotation_deg": 1.8805867170009317e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 21049, - "frame_counter_j": 22445, - "rtk_translation_m": 1.7666235781584831, - "rtk_rotation_deg": 68.22877288971053, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.36708851294331263, - 0.9301836142143228, - 0.0021136490349218744, - 0.7416208149476917 - ], - [ - -0.9300107062704112, - 0.3670624952425087, - -0.0185798495352678, - -0.33550324753487787 - ], - [ - -0.01805851288109898, - 0.004854733104836471, - 0.9998251455524633, - 0.02666998572913017 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10013, - "backend_objective": 128.01055636949394, - "backend_elapsed_sec": 1.5921890999889001, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9713679745493107, - "inlier_rmse_m": 0.2637511985043929, - "target_points": 4984, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9399807553524177, - "inlier_rmse_m": 0.17604025113539679, - "target_points": 8631, - "source_points": 8314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8346948982994331, - "inlier_rmse_m": 0.113068279682314, - "target_points": 12166, - "source_points": 11996 - } - ], - "heldout_symmetric": { - "evaluated": 8380, - "inliers": 7132, - "inlier_ratio": 0.8510739856801909, - "inlier_rmse_m": 0.10418150333394147, - "median_m": 0.08815965835882159, - "p90_m": 0.3087305917346343, - "p95_m": 0.4893728235109789 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6334.468500988184, - 6989.280155724873, - 9593.645454452859, - 10013.0, - 11109.638980418636, - 15001.626672914219 - ], - "effective_rank": 6, - "scaled_condition_number": 2.368253417089997, - "weakest_scaled_direction": [ - -0.5456469190862923, - -0.6892269554539587, - -0.008908771457999964, - 0.17418489298078865, - -0.14332549493413133, - 0.41984961940862864 - ] - }, - "forward_reverse": { - "translation_m": 0.006103232696002816, - "rotation_deg": 0.13366555345652814 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.566190222653667e-15, - "rotation_deg": 1.474615217368706e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 21049, - "frame_counter_j": 23009, - "rtk_translation_m": 2.1807182972588706, - "rtk_rotation_deg": 88.09106909546726, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.028118385051409227, - 0.9995814265189842, - -0.006806480762717368, - 0.5747765467375485 - ], - [ - -0.999351215603629, - 0.02795730029194509, - -0.02270544498430636, - -0.0677657674962029 - ], - [ - -0.022505650260546625, - 0.007440505269036634, - 0.999719027821163, - 0.02069302518692709 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10515, - "backend_objective": 136.50645796897058, - "backend_elapsed_sec": 0.7322920000005979, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9775143090760425, - "inlier_rmse_m": 0.25137481132191286, - "target_points": 4984, - "source_points": 4892 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9514449514449514, - "inlier_rmse_m": 0.1662653992208052, - "target_points": 8631, - "source_points": 8547 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8669304971555776, - "inlier_rmse_m": 0.11393888375561717, - "target_points": 12166, - "source_points": 12129 - } - ], - "heldout_symmetric": { - "evaluated": 8356, - "inliers": 7398, - "inlier_ratio": 0.8853518429870751, - "inlier_rmse_m": 0.10761251229652005, - "median_m": 0.08437689926059491, - "p90_m": 0.2687123552589268, - "p95_m": 0.42387563524420313 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6354.728001404782, - 8352.611667850428, - 10290.658370048182, - 10515.000000000004, - 11989.308880041617, - 16759.23581263924 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6372860976794645, - "weakest_scaled_direction": [ - -0.29097247411742877, - -0.8680264798725017, - -0.003223185305474681, - 0.21917173597589112, - -0.07469053714720127, - 0.3289980766396671 - ] - }, - "forward_reverse": { - "translation_m": 0.003483231665912094, - "rotation_deg": 0.0369774420199415 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.545908510953292e-16, - "rotation_deg": 5.1681392389850166e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 21808, - "frame_counter_j": 22445, - "rtk_translation_m": 0.6269948654714946, - "rtk_rotation_deg": 25.284375303243706, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9030447341715294, - 0.42954041810275, - 0.0022885150593196235, - 0.367458667773597 - ], - [ - -0.42953215295028935, - 0.9030452918131814, - -0.0033660831739380954, - -0.17366596860429281 - ], - [ - -0.0035125015234641114, - 0.002056732884519408, - 0.9999917160571292, - -0.0010345310597696551 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10843, - "backend_objective": 106.00675061189676, - "backend_elapsed_sec": 1.7304479999875184, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.984729586426299, - "inlier_rmse_m": 0.2616249667022414, - "target_points": 4592, - "source_points": 4715 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9560981477026702, - "inlier_rmse_m": 0.152325033921002, - "target_points": 8194, - "source_points": 8314 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.9038846282094032, - "inlier_rmse_m": 0.09887626033891524, - "target_points": 11986, - "source_points": 11996 - } - ], - "heldout_symmetric": { - "evaluated": 8430, - "inliers": 7742, - "inlier_ratio": 0.9183867141162515, - "inlier_rmse_m": 0.09074909570650921, - "median_m": 0.06800174940508802, - "p90_m": 0.20945043332245036, - "p95_m": 0.3765781757127126 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6604.830249080193, - 8840.19173904651, - 10629.947508488453, - 10843.000000000002, - 12770.959493216518, - 18587.52157641432 - ], - "effective_rank": 6, - "scaled_condition_number": 2.8142315359282506, - "weakest_scaled_direction": [ - -0.3384502616878677, - 0.7576369888382872, - 0.0024732199755315904, - -0.19871081248600378, - -0.0870893258711524, - -0.5141604409237267 - ] - }, - "forward_reverse": { - "translation_m": 0.00040199505815422204, - "rotation_deg": 0.011554314408129918 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.143646902843158e-16, - "rotation_deg": 5.18450820282529e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 21808, - "frame_counter_j": 23009, - "rtk_translation_m": 0.9431372257108486, - "rtk_rotation_deg": 45.14667150900044, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7023489450850038, - 0.7118285128507452, - 0.0024754051542978926, - 0.059924493613274954 - ], - [ - -0.711609302823476, - 0.7022113024110725, - -0.022616076167906476, - -0.07987586636228974 - ], - [ - -0.01783702534251465, - 0.01412285590243564, - 0.9997411592347739, - 0.004304137267008405 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10357, - "backend_objective": 140.96465670349417, - "backend_elapsed_sec": 0.6732955999905244, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9899836467702371, - "inlier_rmse_m": 0.24929646828357188, - "target_points": 4592, - "source_points": 4892 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9629109629109629, - "inlier_rmse_m": 0.17553154672561475, - "target_points": 8194, - "source_points": 8547 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.8539038667656031, - "inlier_rmse_m": 0.11666434064962423, - "target_points": 11986, - "source_points": 12129 - } - ], - "heldout_symmetric": { - "evaluated": 8406, - "inliers": 7442, - "inlier_ratio": 0.8853200095170116, - "inlier_rmse_m": 0.10604184939655073, - "median_m": 0.0882151532502487, - "p90_m": 0.2671438287119019, - "p95_m": 0.3725940992291091 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6321.5011558721235, - 8738.942300486915, - 10356.999999999996, - 10401.191191011756, - 11400.032430282545, - 16792.448489132497 - ], - "effective_rank": 6, - "scaled_condition_number": 2.656402027789519, - "weakest_scaled_direction": [ - 0.37052279261799637, - -0.8228446201478125, - -0.010850438718942732, - 0.18603068824881994, - 0.07875239464157928, - 0.38041096539382 - ] - }, - "forward_reverse": { - "translation_m": 0.007320240476189879, - "rotation_deg": 0.12930335868605478 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.0810630699588005e-15, - "rotation_deg": 1.720036083435983e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 21808, - "frame_counter_j": 23738, - "rtk_translation_m": 1.129925637779203, - "rtk_rotation_deg": 87.41573662125148, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.034956863564828515, - 0.9993632171123948, - -0.007153878142224315, - -0.32127950591517335 - ], - [ - -0.9982015526121018, - 0.03456562117527665, - -0.048978344148787725, - -2.022544605994437 - ], - [ - -0.04869987733557226, - 0.008853141562806466, - 0.9987742206484768, - -0.05771150862601452 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8979, - "backend_objective": 126.59537165532059, - "backend_elapsed_sec": 1.1400810000195634, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9229795315467398, - "inlier_rmse_m": 0.34905710552794983, - "target_points": 4592, - "source_points": 4739 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8292448292448292, - "inlier_rmse_m": 0.18142983837507598, - "target_points": 8194, - "source_points": 8316 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7386475814412635, - "inlier_rmse_m": 0.11873942138112017, - "target_points": 11986, - "source_points": 12156 - } - ], - "heldout_symmetric": { - "evaluated": 8483, - "inliers": 6685, - "inlier_ratio": 0.7880466815984911, - "inlier_rmse_m": 0.10871274240898265, - "median_m": 0.09987443726586266, - "p90_m": 0.5989271338106864, - "p95_m": 1.042307189772784 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5066.11839372448, - 7154.53034017749, - 8539.142280164258, - 8978.999999999998, - 11061.666064302934, - 15765.544963482462 - ], - "effective_rank": 6, - "scaled_condition_number": 3.111957466886604, - "weakest_scaled_direction": [ - 0.20518452270900206, - -0.7823014747731898, - -0.02796516388109131, - 0.1858684214239572, - 0.02885519344463898, - 0.5565446716536907 - ] - }, - "forward_reverse": { - "translation_m": 0.0063952430610542755, - "rotation_deg": 0.039517035902874385 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7201880167252704e-15, - "rotation_deg": 3.4341887907319502e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 22445, - "frame_counter_j": 23009, - "rtk_translation_m": 0.44809323479571145, - "rtk_rotation_deg": 19.862296205756735, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.940129337285168, - 0.3408176479611037, - 0.00040001751423761, - -0.3090525318122643 - ], - [ - -0.34081145984607186, - 0.9401181782377067, - -0.005035849938632279, - -0.06150678590856295 - ], - [ - -0.002092370268317959, - 0.004598019712482603, - 0.9999872400192832, - -0.00046194103304580335 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 10943, - "backend_objective": 95.03463894867873, - "backend_elapsed_sec": 0.5891648000106215, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9656582174979559, - "inlier_rmse_m": 0.23006334615117718, - "target_points": 4715, - "source_points": 4892 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.9468819468819469, - "inlier_rmse_m": 0.13876472207650142, - "target_points": 8314, - "source_points": 8547 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.902217825047407, - "inlier_rmse_m": 0.09319074098486065, - "target_points": 11996, - "source_points": 12129 - } - ], - "heldout_symmetric": { - "evaluated": 8416, - "inliers": 7818, - "inlier_ratio": 0.9289448669201521, - "inlier_rmse_m": 0.0850509551532673, - "median_m": 0.06297352923183072, - "p90_m": 0.19662620313791002, - "p95_m": 0.3419859428441886 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6436.785156566374, - 9053.997463060621, - 10762.59977378392, - 10942.999999999996, - 13132.612044155389, - 19073.822078919267 - ], - "effective_rank": 6, - "scaled_condition_number": 2.96325286846982, - "weakest_scaled_direction": [ - 0.6501163887984533, - -0.5292009822570725, - 0.009774766482022202, - 0.12960273835377986, - 0.1684877802053284, - 0.5020104117114625 - ] - }, - "forward_reverse": { - "translation_m": 0.005157655135591474, - "rotation_deg": 0.022666807877311387 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3669411984536294e-15, - "rotation_deg": 1.799536464903132e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 22445, - "frame_counter_j": 23738, - "rtk_translation_m": 1.160064136065596, - "rtk_rotation_deg": 62.13136131800778, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4608780212576795, - 0.8874417535367568, - 0.006211569947420817, - 0.1753206383072172 - ], - [ - -0.8864041682474931, - 0.4606584982758418, - -0.04562234627587741, - -1.959863954140555 - ], - [ - -0.04334858746344002, - 0.01552037518400438, - 0.9989394465727498, - -0.055993036823545034 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8950, - "backend_objective": 116.72392086733629, - "backend_elapsed_sec": 0.6143317999958526, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9052542730533868, - "inlier_rmse_m": 0.3282603185880566, - "target_points": 4715, - "source_points": 4739 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8282828282828283, - "inlier_rmse_m": 0.18031125391494027, - "target_points": 8314, - "source_points": 8316 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7362619282658769, - "inlier_rmse_m": 0.11420060800126593, - "target_points": 11996, - "source_points": 12156 - } - ], - "heldout_symmetric": { - "evaluated": 8493, - "inliers": 6686, - "inlier_ratio": 0.7872365477452019, - "inlier_rmse_m": 0.10455513464835667, - "median_m": 0.09656351181790844, - "p90_m": 0.5837300322156737, - "p95_m": 1.0840981465293762 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5004.494243501986, - 5878.097736393739, - 7647.053972393816, - 8949.999999999998, - 11392.978253653338, - 14824.12649224894 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9621627623005296, - "weakest_scaled_direction": [ - 0.4626624155505667, - -0.6395297686100232, - -0.023224714791810926, - 0.15106664872262085, - 0.0879311384051886, - 0.5880924752654536 - ] - }, - "forward_reverse": { - "translation_m": 0.011650639607012138, - "rotation_deg": 0.1624719134077532 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0609248831790639e-15, - "rotation_deg": 1.2643853824624548e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 22445, - "frame_counter_j": 24656, - "rtk_translation_m": 4.25412615059095, - "rtk_rotation_deg": 152.09392556214777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8693419651935, - 0.49328851370887117, - -0.030182607514841687, - 3.5994705600121075 - ], - [ - -0.4929278889355686, - -0.86986433719558, - -0.01892435427747753, - 2.4988644187071802 - ], - [ - -0.03558994047516922, - -0.0015738863327385481, - 0.9993652380480256, - -0.21509551291085394 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 457, - "backend_objective": 11.31425135778671, - "backend_elapsed_sec": 0.8596451999910641, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.36999748301031965, - "inlier_rmse_m": 0.7559109677704624, - "target_points": 4715, - "source_points": 3973 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.10055791710945802, - "inlier_rmse_m": 0.3313478529407446, - "target_points": 8314, - "source_points": 7528 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.04094248342590934, - "inlier_rmse_m": 0.15734567555040377, - "target_points": 11996, - "source_points": 11162 - } - ], - "heldout_symmetric": { - "evaluated": 8576, - "inliers": 411, - "inlier_ratio": 0.04792444029850746, - "inlier_rmse_m": 0.15706827084964883, - "median_m": 1.510041034247014, - "p90_m": 2.642977987575308, - "p95_m": 2.9676196688610803 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 188.0846288115085, - 373.67419174036627, - 430.05727673396564, - 456.99999999999994, - 517.2985481578297, - 641.6523616999016 - ], - "effective_rank": 6, - "scaled_condition_number": 3.4115087753552786, - "weakest_scaled_direction": [ - 0.6752870842984472, - -0.726883511143531, - 0.025130774183960636, - 0.05639725041111904, - 0.04904010731572828, - -0.09700812964281118 - ] - }, - "forward_reverse": { - "translation_m": 2.5641513880069633, - "rotation_deg": 2.874944882076104 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.5647251439453833, - "rotation_deg": 2.8441942793626005 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 23009, - "frame_counter_j": 23738, - "rtk_translation_m": 1.5995723610319212, - "rtk_rotation_deg": 42.26906511225104, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7357203674880102, - 0.6771641842998001, - 0.012814381174763, - 1.1089783875774961 - ], - [ - -0.6767172982756025, - 0.7357464343940727, - -0.027034838467685285, - -1.6295389871904071 - ], - [ - -0.027735159596945322, - 0.011218367884765157, - 0.9995523543787656, - -0.01525339546648255 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 9087, - "backend_objective": 125.22406224059179, - "backend_elapsed_sec": 1.980666100018425, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9358514454526271, - "inlier_rmse_m": 0.3247867534470612, - "target_points": 4892, - "source_points": 4739 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8626743626743627, - "inlier_rmse_m": 0.18098084215694493, - "target_points": 8547, - "source_points": 8316 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7475320829220138, - "inlier_rmse_m": 0.1173906831594268, - "target_points": 12129, - "source_points": 12156 - } - ], - "heldout_symmetric": { - "evaluated": 8469, - "inliers": 6776, - "inlier_ratio": 0.8000944621560987, - "inlier_rmse_m": 0.1086547547358129, - "median_m": 0.10176035403550192, - "p90_m": 0.5001289181517845, - "p95_m": 0.9253560005897886 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4855.868729434682, - 7105.390346217539, - 8461.16943375336, - 9087.0, - 11019.618291316021, - 15279.58536408583 - ], - "effective_rank": 6, - "scaled_condition_number": 3.1466224100058553, - "weakest_scaled_direction": [ - 0.7998075151906056, - -0.2596437493269175, - -0.007241923079475405, - 0.05928970424608462, - 0.1683876149490679, - 0.5108531674878579 - ] - }, - "forward_reverse": { - "translation_m": 0.0011394164967304414, - "rotation_deg": 0.02119627748719656 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5554731959909575e-15, - "rotation_deg": 3.7838126105272676e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 23009, - "frame_counter_j": 24656, - "rtk_translation_m": 4.295353381127667, - "rtk_rotation_deg": 132.23162935639104, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6533698788903878, - 0.7566387544884615, - -0.024608871670858276, - 2.7778991716424835 - ], - [ - -0.7559861378941994, - -0.6538302043417603, - -0.03148052099673738, - 3.7712844164127466 - ], - [ - -0.03990940579079673, - -0.0019644583386584777, - 0.9992013712124617, - -0.14949593975793155 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 455, - "backend_objective": 11.847117354606477, - "backend_elapsed_sec": 1.2905711999919731, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.35112006040775234, - "inlier_rmse_m": 0.7664749102573049, - "target_points": 4892, - "source_points": 3973 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.10175345377258235, - "inlier_rmse_m": 0.31880175094938373, - "target_points": 8547, - "source_points": 7528 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.04076330406737144, - "inlier_rmse_m": 0.16136176920068357, - "target_points": 12129, - "source_points": 11162 - } - ], - "heldout_symmetric": { - "evaluated": 8552, - "inliers": 360, - "inlier_ratio": 0.042095416276894296, - "inlier_rmse_m": 0.16025490727880456, - "median_m": 1.5565295506022245, - "p90_m": 2.614866368465739, - "p95_m": 2.9080579883218474 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 191.9018716774536, - 387.5185478311202, - 413.48214090728476, - 455.0, - 729.8500445195981, - 888.7030537153191 - ], - "effective_rank": 6, - "scaled_condition_number": 4.631028587407634, - "weakest_scaled_direction": [ - 0.8459470349633543, - -0.510586130810404, - 0.036301421360995886, - 0.05610061406792018, - 0.08517442454844952, - -0.10934195156473282 - ] - }, - "forward_reverse": { - "translation_m": 2.5607552487652696, - "rotation_deg": 2.17230408479254 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.5619449483977585, - "rotation_deg": 2.1577786731375026 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "heldout_inlier_rmse", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 23009, - "frame_counter_j": 25326, - "rtk_translation_m": 5.754426930327516, - "rtk_rotation_deg": 158.8421298011293, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9302206964005612, - 0.365347289201367, - -0.03479675647622887, - 2.824392235322527 - ], - [ - -0.36353296356779685, - -0.9302833338581108, - -0.049159975035134175, - 1.7615669777958702 - ], - [ - -0.05033130623844817, - -0.033079858207866235, - 0.9981845934461615, - 0.10255675720015657 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8104, - "backend_objective": 101.47059390369647, - "backend_elapsed_sec": 1.3112240000045858, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8509331443420742, - "inlier_rmse_m": 0.3566197508687418, - "target_points": 4892, - "source_points": 4233 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7776364330237884, - "inlier_rmse_m": 0.17830111444065264, - "target_points": 8547, - "source_points": 7861 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7037165682528655, - "inlier_rmse_m": 0.11189750033140437, - "target_points": 12129, - "source_points": 11516 - } - ], - "heldout_symmetric": { - "evaluated": 8581, - "inliers": 6406, - "inlier_ratio": 0.7465330381074466, - "inlier_rmse_m": 0.1066966653439246, - "median_m": 0.1038479524009454, - "p90_m": 1.0068343104061177, - "p95_m": 1.9557779089473875 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4273.6926928735365, - 5539.132277480686, - 7996.38131785358, - 8104.0, - 8404.053932945493, - 10267.9670841991 - ], - "effective_rank": 6, - "scaled_condition_number": 2.402598366822474, - "weakest_scaled_direction": [ - 0.9139788290624762, - 0.33235359567279144, - -0.008335557504596035, - -0.05843009782010007, - 0.1645390382037056, - 0.15371120494541698 - ] - }, - "forward_reverse": { - "translation_m": 0.00635764905956918, - "rotation_deg": 0.040016615214377715 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.6489874298927905e-15, - "rotation_deg": 2.2669497728165652e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 23738, - "frame_counter_j": 24656, - "rtk_translation_m": 4.099530130205247, - "rtk_rotation_deg": 89.96256424413995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0017015734686510722, - 0.9997757384508612, - -0.021108705615598577, - -2.6583990253190706 - ], - [ - -0.9989410962918163, - 0.0007288991444849446, - -0.04600168307071181, - 2.5579828648386203 - ], - [ - -0.04597598054453888, - 0.021164628772373715, - 0.9987183124895077, - -0.02331550577672528 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7945, - "backend_objective": 102.88241479434289, - "backend_elapsed_sec": 1.2573650999984238, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8749056128869872, - "inlier_rmse_m": 0.34415015279828515, - "target_points": 4739, - "source_points": 3973 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7978214665249734, - "inlier_rmse_m": 0.17473631458402464, - "target_points": 8316, - "source_points": 7528 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7117900017917936, - "inlier_rmse_m": 0.11379511625114151, - "target_points": 12156, - "source_points": 11162 - } - ], - "heldout_symmetric": { - "evaluated": 8629, - "inliers": 6255, - "inlier_ratio": 0.7248812145092132, - "inlier_rmse_m": 0.10870831469083347, - "median_m": 0.10951188859898933, - "p90_m": 0.9294188799438398, - "p95_m": 2.042546300010314 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3763.8927308442508, - 5432.562954317404, - 7107.705721151835, - 7944.999999999998, - 8832.91034588967, - 11092.652504773385 - ], - "effective_rank": 6, - "scaled_condition_number": 2.9471223804737057, - "weakest_scaled_direction": [ - 0.2918166000853768, - -0.863638115122693, - 0.023612110311937273, - 0.13778695636451369, - 0.057010261827101755, - 0.3823340567759548 - ] - }, - "forward_reverse": { - "translation_m": 0.00465638537716095, - "rotation_deg": 0.12465763189227934 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.983207951185934e-15, - "rotation_deg": 5.129885440253511e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 23738, - "frame_counter_j": 25326, - "rtk_translation_m": 4.890018768530818, - "rtk_rotation_deg": 116.57306468887772, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4370045644919571, - 0.8992031149555768, - -0.021465522760562964, - -1.0336450423483996 - ], - [ - -0.897967497556909, - -0.4375294274743018, - -0.04714205580364749, - 3.656761712508662 - ], - [ - -0.051782081307915145, - -0.0013259518086748945, - 0.9986575278378579, - 0.06093438749413569 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7923, - "backend_objective": 102.43587166334136, - "backend_elapsed_sec": 0.7656470999936573, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8525868178596739, - "inlier_rmse_m": 0.364741045211601, - "target_points": 4739, - "source_points": 4233 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7646609846075563, - "inlier_rmse_m": 0.17892429270763288, - "target_points": 8316, - "source_points": 7861 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6879993053143453, - "inlier_rmse_m": 0.11370543021198332, - "target_points": 12156, - "source_points": 11516 - } - ], - "heldout_symmetric": { - "evaluated": 8658, - "inliers": 6271, - "inlier_ratio": 0.7243012243012243, - "inlier_rmse_m": 0.11138751941762699, - "median_m": 0.11493050218901205, - "p90_m": 1.0537147117058252, - "p95_m": 1.993621193944296 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3702.472769167777, - 5242.628144204906, - 7269.6092761292875, - 7923.0, - 8479.899961048737, - 10235.493865034827 - ], - "effective_rank": 6, - "scaled_condition_number": 2.7645021322697017, - "weakest_scaled_direction": [ - -0.05858390590873623, - 0.9455899033254807, - -0.023407522559643273, - -0.142152099320647, - -0.015870515358267268, - -0.28534304965427404 - ] - }, - "forward_reverse": { - "translation_m": 0.004263906321896464, - "rotation_deg": 0.046637396086304225 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.356610190004922e-15, - "rotation_deg": 1.2233139066312992e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 23738, - "frame_counter_j": 26097, - "rtk_translation_m": 4.464737187763289, - "rtk_rotation_deg": 159.39493219688632, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9295919387998384, - 0.36456839178075, - -0.054302072085278145, - -2.8908105269081292 - ], - [ - -0.3628824367250795, - -0.9310367075571268, - -0.0385614613008016, - 3.962757118171067 - ], - [ - -0.06461551233895604, - -0.01614115533604047, - 0.9977796844341897, - 0.015994269907167236 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7213, - "backend_objective": 94.54083773136172, - "backend_elapsed_sec": 0.6597700999991503, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8009293225727562, - "inlier_rmse_m": 0.3953569665736006, - "target_points": 4739, - "source_points": 4089 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7113985448666128, - "inlier_rmse_m": 0.17809313203635674, - "target_points": 8316, - "source_points": 7422 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6609548245212132, - "inlier_rmse_m": 0.1144858352756756, - "target_points": 12156, - "source_points": 10913 - } - ], - "heldout_symmetric": { - "evaluated": 8673, - "inliers": 6033, - "inlier_ratio": 0.6956070563818748, - "inlier_rmse_m": 0.1103354081949904, - "median_m": 0.1202910301149279, - "p90_m": 1.3288598222169319, - "p95_m": 2.302821478219939 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3009.307606564352, - 4717.3040479664405, - 6143.996201614695, - 7213.000000000002, - 8056.716935688335, - 9711.073529388763 - ], - "effective_rank": 6, - "scaled_condition_number": 3.227012588611917, - "weakest_scaled_direction": [ - 0.26335827960407093, - -0.8941869496593108, - 0.03423445494296838, - 0.10967302401686123, - 0.04533049596262965, - 0.3403191026911331 - ] - }, - "forward_reverse": { - "translation_m": 0.011088061861347823, - "rotation_deg": 0.34561739459504637 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.9814160980877515e-15, - "rotation_deg": 4.2365352857005895e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 24656, - "frame_counter_j": 25326, - "rtk_translation_m": 2.3862917603439455, - "rtk_rotation_deg": 26.61050044473775, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8987838272010792, - 0.43839003315083136, - 0.0013456581267806136, - -1.1000232013970885 - ], - [ - -0.43838650132041823, - 0.898783628842838, - -0.0022943374086413304, - 1.623372648657991 - ], - [ - -0.0022152701470032, - 0.0014721949988565216, - 0.9999964626037742, - 0.01227745168444494 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8906, - "backend_objective": 99.50532777016456, - "backend_elapsed_sec": 0.6612015999853611, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9045594141270966, - "inlier_rmse_m": 0.30641925920418384, - "target_points": 3973, - "source_points": 4233 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.855616333799771, - "inlier_rmse_m": 0.1662225543981025, - "target_points": 7528, - "source_points": 7861 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7733588051406739, - "inlier_rmse_m": 0.10570166343988935, - "target_points": 11162, - "source_points": 11516 - } - ], - "heldout_symmetric": { - "evaluated": 8741, - "inliers": 7155, - "inlier_ratio": 0.8185562292643862, - "inlier_rmse_m": 0.0961579573295129, - "median_m": 0.07594019619194607, - "p90_m": 0.45491976817997126, - "p95_m": 0.7769375652135185 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4453.964231396102, - 5543.482099249372, - 7449.354617113133, - 8905.999999999998, - 10373.766159854848, - 12914.528547263404 - ], - "effective_rank": 6, - "scaled_condition_number": 2.899558208444643, - "weakest_scaled_direction": [ - 0.7120457384764026, - -0.49980290696893237, - 0.0196003785835027, - 0.08584793177264372, - 0.10371498741182765, - -0.4740011388793349 - ] - }, - "forward_reverse": { - "translation_m": 0.004999163455591531, - "rotation_deg": 0.0213847958734735 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9690272995027716e-15, - "rotation_deg": 9.700555871897717e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 24656, - "frame_counter_j": 26097, - "rtk_translation_m": 1.1507634071714652, - "rtk_rotation_deg": 69.43236795274659, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.36387986477157686, - 0.931404752986997, - -0.008753863549936883, - -1.4009527791762526 - ], - [ - -0.9310693701763868, - 0.36344951509615775, - -0.031847729836107265, - -0.23086150164562821 - ], - [ - -0.0264815394787536, - 0.0197392018480942, - 0.9994543971473812, - -0.03210156240484504 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8454, - "backend_objective": 102.00989553236812, - "backend_elapsed_sec": 0.6016227999934927, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9141599413059428, - "inlier_rmse_m": 0.3180386884006071, - "target_points": 3973, - "source_points": 4089 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8654001616814875, - "inlier_rmse_m": 0.18217732603319353, - "target_points": 7528, - "source_points": 7422 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7746724090534225, - "inlier_rmse_m": 0.10984746264689386, - "target_points": 11162, - "source_points": 10913 - } - ], - "heldout_symmetric": { - "evaluated": 8756, - "inliers": 7041, - "inlier_ratio": 0.8041343079031521, - "inlier_rmse_m": 0.099533431536842, - "median_m": 0.08002985449770786, - "p90_m": 0.48043747303466966, - "p95_m": 0.8602355104919983 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4311.887528041993, - 5266.0144157268605, - 7562.045487088288, - 8454.000000000005, - 9295.343551771231, - 11273.933890577873 - ], - "effective_rank": 6, - "scaled_condition_number": 2.6146168742247573, - "weakest_scaled_direction": [ - 0.9521847012693492, - -0.01596727240636242, - 0.03432307538317788, - 0.011993735212950205, - 0.15217478825270542, - -0.26193558657163796 - ] - }, - "forward_reverse": { - "translation_m": 0.003171376495143, - "rotation_deg": 0.02376737774843464 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.4370957682360787e-16, - "rotation_deg": 8.861539215587854e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 24656, - "frame_counter_j": 27704, - "rtk_translation_m": 2.4361832484951105, - "rtk_rotation_deg": 160.7145717128102, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9442498510776686, - 0.32874233840054756, - 0.017907922345713957, - -0.31553262485168 - ], - [ - -0.3291367354105927, - -0.9438784074418034, - -0.027614513727080063, - 2.4439985539052493 - ], - [ - 0.007824841407829687, - -0.031969155573232294, - 0.9994582257147502, - 0.8495727932898036 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 777, - "backend_objective": 15.620004693475606, - "backend_elapsed_sec": 1.232938600005582, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.3087130696044066, - "inlier_rmse_m": 0.7569595846254803, - "target_points": 3973, - "source_points": 3994 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.11655239960822723, - "inlier_rmse_m": 0.3094587368058975, - "target_points": 7528, - "source_points": 7147 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.07430429377450512, - "inlier_rmse_m": 0.1417849291831443, - "target_points": 11162, - "source_points": 10457 - } - ], - "heldout_symmetric": { - "evaluated": 8429, - "inliers": 695, - "inlier_ratio": 0.0824534345711235, - "inlier_rmse_m": 0.13003518012314966, - "median_m": 1.495005480118762, - "p90_m": 2.700641613327596, - "p95_m": 2.9804503927712616 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 110.73146019210188, - 131.53032357331114, - 237.86413986941471, - 776.9999999999998, - 803.0217196499735, - 807.376695516047 - ], - "effective_rank": 6, - "scaled_condition_number": 7.2913036106936, - "weakest_scaled_direction": [ - 0.8148426069139895, - -0.557883765194359, - 0.02239601106756256, - 0.05516123094431681, - 0.0755633556690448, - -0.12467183747415381 - ] - }, - "forward_reverse": { - "translation_m": 1.3743823383381788, - "rotation_deg": 1.9837113244583153 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.74680554853272, - "rotation_deg": 3.515023932230732 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784786319.6581354, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 25326, - "frame_counter_j": 26097, - "rtk_translation_m": 1.2514382602180638, - "rtk_rotation_deg": 42.82186750800885, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.73539344737915, - 0.6776240077230559, - 0.00470974618776515, - 0.5446436109045508 - ], - [ - -0.6771417809653044, - 0.7351011785770846, - -0.033245536929295265, - -1.8023941104342365 - ], - [ - -0.025990113946359007, - 0.021259384090927466, - 0.9994361173007157, - -0.038656847052263084 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 8321, - "backend_objective": 104.68954435407265, - "backend_elapsed_sec": 0.6357737999933306, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.9158718513083883, - "inlier_rmse_m": 0.3194253893460661, - "target_points": 4233, - "source_points": 4089 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.8613581244947454, - "inlier_rmse_m": 0.18148424991779427, - "target_points": 7861, - "source_points": 7422 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.7624851095024283, - "inlier_rmse_m": 0.11216668731753437, - "target_points": 11516, - "source_points": 10913 - } - ], - "heldout_symmetric": { - "evaluated": 8785, - "inliers": 7166, - "inlier_ratio": 0.8157085941946499, - "inlier_rmse_m": 0.09925944770258267, - "median_m": 0.07888441155086569, - "p90_m": 0.48392640367799045, - "p95_m": 0.9608094865127568 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3699.3023510760745, - 4727.224613115375, - 6699.125724884189, - 8320.999999999998, - 9608.325626652204, - 11277.475406838334 - ], - "effective_rank": 6, - "scaled_condition_number": 3.0485411400768245, - "weakest_scaled_direction": [ - 0.6926566303503612, - 0.6473051237198294, - 0.04322918919707361, - -0.08602483210067127, - 0.0723860481745139, - 0.2944725704218168 - ] - }, - "forward_reverse": { - "translation_m": 0.004719596234887584, - "rotation_deg": 0.06146741991681224 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0577403687701087e-09, - "rotation_deg": 5.017501916348629e-09 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784786319.6581354, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 25326, - "frame_counter_j": 27704, - "rtk_translation_m": 0.641507519046697, - "rtk_rotation_deg": 134.10407126807203, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6933790222488846, - 0.7198797992021888, - 0.031600731095929126, - 0.30033073323356396 - ], - [ - -0.7205493390367719, - -0.6923333000902168, - -0.03851300559373108, - 1.1422920118631261 - ], - [ - -0.005846496288579847, - -0.04947399606669754, - 0.9987583001879591, - 1.031248314724261 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 922, - "backend_objective": 17.384443340953343, - "backend_elapsed_sec": 1.071740299987141, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.2789183775663495, - "inlier_rmse_m": 0.7592150008800915, - "target_points": 4233, - "source_points": 3994 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.11837134462012033, - "inlier_rmse_m": 0.288204181433143, - "target_points": 7861, - "source_points": 7147 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.08817060342354403, - "inlier_rmse_m": 0.137314036505466, - "target_points": 11516, - "source_points": 10457 - } - ], - "heldout_symmetric": { - "evaluated": 8458, - "inliers": 771, - "inlier_ratio": 0.0911563017261764, - "inlier_rmse_m": 0.12702324561674966, - "median_m": 1.5446327277209206, - "p90_m": 2.7042136173463582, - "p95_m": 2.99612947209192 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 126.60189343830119, - 156.46318587256008, - 279.85523956074167, - 922.0, - 950.1325558860659, - 954.7661331450001 - ], - "effective_rank": 6, - "scaled_condition_number": 7.541483837366941, - "weakest_scaled_direction": [ - 0.2714300577340671, - -0.9462800437433, - -0.02061021284124718, - 0.09930271056452261, - 0.031533101853772, - -0.13999877449576664 - ] - }, - "forward_reverse": { - "translation_m": 2.816294381538612, - "rotation_deg": 3.333105317420589 - }, - "multistart": { - "runs": 1, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.8150792789684056, - "rotation_deg": 3.358304138889011 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784786396.7558627, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 26097, - "frame_counter_j": 27704, - "rtk_translation_m": 1.4370687242949811, - "rtk_rotation_deg": 91.2822037600631, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.02543240520904842, - 0.9995826198764401, - -0.013703240720100419, - -2.551526100664499 - ], - [ - -0.9993201072742216, - -0.0257869658655089, - -0.026350627865156382, - -0.5746587162569765 - ], - [ - -0.026692994637538076, - 0.013023764141035744, - 0.9995588354893767, - -0.06709909389428405 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "open3d", - "backend_converged": null, - "backend_iterations": null, - "backend_num_inliers": 7170, - "backend_objective": 92.68266713845796, - "backend_elapsed_sec": 1.1681094999948982, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "fitness": 0.8375062593890836, - "inlier_rmse_m": 0.35349725672907956, - "target_points": 4089, - "source_points": 3994 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "fitness": 0.7554218553239122, - "inlier_rmse_m": 0.18476958522923292, - "target_points": 7422, - "source_points": 7147 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "fitness": 0.6856651047145452, - "inlier_rmse_m": 0.11369455958156494, - "target_points": 10913, - "source_points": 10457 - } - ], - "heldout_symmetric": { - "evaluated": 8473, - "inliers": 6414, - "inlier_ratio": 0.7569928006609229, - "inlier_rmse_m": 0.10008740880870744, - "median_m": 0.08834857877411445, - "p90_m": 0.9960371547843112, - "p95_m": 2.5088898917980305 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 2731.3996047233045, - 3840.7390248544434, - 5107.964710787966, - 7169.999999999998, - 8585.485028460402, - 9999.939188218461 - ], - "effective_rank": 6, - "scaled_condition_number": 3.6611044282667207, - "weakest_scaled_direction": [ - 0.6024362256505087, - 0.6605258105471334, - 0.052965444184604, - -0.04340562970352462, - 0.07458905967670341, - -0.4364897854863681 - ] - }, - "forward_reverse": { - "translation_m": 2.988193350509204, - "rotation_deg": 2.696443494598379 - }, - "multistart": { - "runs": 1, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.826405982230485e-15, - "rotation_deg": 1.038543983377488e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - } - ] -} \ No newline at end of file diff --git a/results/02_data4_calibration/open3d_gicp/B_refined.npz b/results/02_data4_calibration/open3d_gicp/B_refined.npz deleted file mode 100644 index 0d80e89..0000000 Binary files a/results/02_data4_calibration/open3d_gicp/B_refined.npz and /dev/null differ diff --git a/results/02_data4_calibration/open3d_gicp/B_refined.refinement.json b/results/02_data4_calibration/open3d_gicp/B_refined.refinement.json deleted file mode 100644 index e66ee06..0000000 --- a/results/02_data4_calibration/open3d_gicp/B_refined.refinement.json +++ /dev/null @@ -1,1072 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 87, - "accepted_pairs": 42, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.8061657032755298, - "heldout_inlier_rmse_m": 0.10961296014103376, - "rotation_invariant_error_deg": 0.021953694767613996, - "reverse_translation_m": 0.004225163540003135, - "reverse_rotation_deg": 0.15304490677206398, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.7489394523717702, - "heldout_inlier_rmse_m": 0.116305716193008, - "rotation_invariant_error_deg": 0.6722513635970557, - "reverse_translation_m": 0.02073003109723772, - "reverse_rotation_deg": 0.12418344306820694, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.6310283235519265, - "heldout_inlier_rmse_m": 0.12470979645173065, - "rotation_invariant_error_deg": 0.31955029067046326, - "reverse_translation_m": 0.02154775870989581, - "reverse_rotation_deg": 0.2539904497958252, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 1, - "j": 2, - "heldout_inlier_ratio": 0.7867383512544803, - "heldout_inlier_rmse_m": 0.11079021393934936, - "rotation_invariant_error_deg": 0.6532823847336076, - "reverse_translation_m": 0.0076823267394430066, - "reverse_rotation_deg": 0.05080433004685343, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.6794562317367552, - "heldout_inlier_rmse_m": 0.1190716913809658, - "rotation_invariant_error_deg": 0.28968149037614666, - "reverse_translation_m": 0.024832426027852336, - "reverse_rotation_deg": 0.29364033194785566, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 1, - "j": 4, - "heldout_inlier_ratio": 0.6786112833230006, - "heldout_inlier_rmse_m": 0.11255015823152649, - "rotation_invariant_error_deg": 0.2350920621707786, - "reverse_translation_m": 0.007769137931169012, - "reverse_rotation_deg": 0.07270245476793177, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.7586776859504132, - "heldout_inlier_rmse_m": 0.11541610277862563, - "rotation_invariant_error_deg": 0.06385020919199477, - "reverse_translation_m": 0.007879904085793275, - "reverse_rotation_deg": 0.11659483159946175, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.7854572527608884, - "heldout_inlier_rmse_m": 0.1098649389241601, - "rotation_invariant_error_deg": 0.8714733340458736, - "reverse_translation_m": 0.017042953274278242, - "reverse_rotation_deg": 0.09383247792992147, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.7074574574574575, - "heldout_inlier_rmse_m": 0.11912871456224478, - "rotation_invariant_error_deg": 0.18237928888538768, - "reverse_translation_m": 0.016641241123247028, - "reverse_rotation_deg": 0.24777402858141082, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.6974624291697462, - "heldout_inlier_rmse_m": 0.1172763088894914, - "rotation_invariant_error_deg": 0.490243673582313, - "reverse_translation_m": 0.012148721219467648, - "reverse_rotation_deg": 0.2079308684382429, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.7962985964476462, - "heldout_inlier_rmse_m": 0.10646082199215777, - "rotation_invariant_error_deg": 0.552273782508431, - "reverse_translation_m": 0.011008298723511818, - "reverse_rotation_deg": 0.08217077610411756, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.8376509054325956, - "heldout_inlier_rmse_m": 0.10956583416752592, - "rotation_invariant_error_deg": 0.24026261153986894, - "reverse_translation_m": 0.001222821038316072, - "reverse_rotation_deg": 0.09207521511761255, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.6652516676773802, - "heldout_inlier_rmse_m": 0.12322094568314959, - "rotation_invariant_error_deg": 1.0602492186818964, - "reverse_translation_m": 0.005399786589867114, - "reverse_rotation_deg": 0.1389350777589359, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6529585072428186, - "heldout_inlier_rmse_m": 0.11878586101480827, - "rotation_invariant_error_deg": 0.2660016441779476, - "reverse_translation_m": 0.011377811219747914, - "reverse_rotation_deg": 0.20418431358287809, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.6964418087472202, - "heldout_inlier_rmse_m": 0.11691192595448072, - "rotation_invariant_error_deg": 0.25710683125699063, - "reverse_translation_m": 0.017641796253111963, - "reverse_rotation_deg": 0.10886712169052283, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.7526921648718901, - "heldout_inlier_rmse_m": 0.10924852668609378, - "rotation_invariant_error_deg": 0.8049600839827704, - "reverse_translation_m": 0.012374747586501101, - "reverse_rotation_deg": 0.14461856068326442, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.7833561729164071, - "heldout_inlier_rmse_m": 0.11683079277948674, - "rotation_invariant_error_deg": 0.7937418989475873, - "reverse_translation_m": 0.0136898748124479, - "reverse_rotation_deg": 0.2000656277647698, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.7410703250525275, - "heldout_inlier_rmse_m": 0.11436945722491815, - "rotation_invariant_error_deg": 0.4895932719632867, - "reverse_translation_m": 0.020336999081352437, - "reverse_rotation_deg": 0.07548452187379719, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.8497729566094854, - "heldout_inlier_rmse_m": 0.10415909908074772, - "rotation_invariant_error_deg": 0.026617733421606005, - "reverse_translation_m": 0.008986805974948919, - "reverse_rotation_deg": 0.1309947950641294, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.7678928928928929, - "heldout_inlier_rmse_m": 0.11166725079781287, - "rotation_invariant_error_deg": 0.32815442351947866, - "reverse_translation_m": 0.010085391730565987, - "reverse_rotation_deg": 0.11752836996157842, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "heldout_inlier_ratio": 0.6071384156199477, - "heldout_inlier_rmse_m": 0.12594282886521954, - "rotation_invariant_error_deg": 0.06220808914818576, - "reverse_translation_m": 0.01655440444551025, - "reverse_rotation_deg": 0.4345945520890901, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.8299748110831234, - "heldout_inlier_rmse_m": 0.10748525688830209, - "rotation_invariant_error_deg": 0.29848794137559764, - "reverse_translation_m": 0.007106461978852689, - "reverse_rotation_deg": 0.10698728473689886, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "heldout_inlier_ratio": 0.6188509200150206, - "heldout_inlier_rmse_m": 0.1271320507839345, - "rotation_invariant_error_deg": 0.060817415136170894, - "reverse_translation_m": 0.026230622734929154, - "reverse_rotation_deg": 0.28112746782878123, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 7, - "j": 10, - "heldout_inlier_ratio": 0.5757088027733069, - "heldout_inlier_rmse_m": 0.1313446077529101, - "rotation_invariant_error_deg": 0.08805329493384306, - "reverse_translation_m": 0.012710332356906473, - "reverse_rotation_deg": 0.2297418063823675, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 8, - "j": 9, - "heldout_inlier_ratio": 0.6326834719980131, - "heldout_inlier_rmse_m": 0.12084265385763356, - "rotation_invariant_error_deg": 0.5779508072572632, - "reverse_translation_m": 0.02518064403521875, - "reverse_rotation_deg": 0.3859647522318924, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.6163861933423412, - "heldout_inlier_rmse_m": 0.12936028463965984, - "rotation_invariant_error_deg": 0.22960778579899, - "reverse_translation_m": 0.011327540721525892, - "reverse_rotation_deg": 0.17059480981566058, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 11, - "heldout_inlier_ratio": 0.5371195721380364, - "heldout_inlier_rmse_m": 0.13463285672049757, - "rotation_invariant_error_deg": 0.1575176157841085, - "reverse_translation_m": 0.017887959781482814, - "reverse_rotation_deg": 0.14919899299178907, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.6543345543345543, - "heldout_inlier_rmse_m": 0.10729272360686735, - "rotation_invariant_error_deg": 0.1786491689335179, - "reverse_translation_m": 0.008725655639009402, - "reverse_rotation_deg": 0.02870462611907292, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.5818780055682106, - "heldout_inlier_rmse_m": 0.11717687815100752, - "rotation_invariant_error_deg": 0.2635280280577561, - "reverse_translation_m": 0.009813025835682346, - "reverse_rotation_deg": 0.0603546019895227, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.5379123584441162, - "heldout_inlier_rmse_m": 0.12645695585785732, - "rotation_invariant_error_deg": 0.5448949372769469, - "reverse_translation_m": 0.008862930161052695, - "reverse_rotation_deg": 0.11566409877698863, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.7118898623279099, - "heldout_inlier_rmse_m": 0.1192865608074921, - "rotation_invariant_error_deg": 0.037876295004004135, - "reverse_translation_m": 0.0029529340190147615, - "reverse_rotation_deg": 0.0041769080934441144, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.6120311738918656, - "heldout_inlier_rmse_m": 0.1252565212812615, - "rotation_invariant_error_deg": 0.22694248875487233, - "reverse_translation_m": 0.005686910809265337, - "reverse_rotation_deg": 0.10204044727301474, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.516551290119572, - "heldout_inlier_rmse_m": 0.1354903305714049, - "rotation_invariant_error_deg": 0.7336960316225429, - "reverse_translation_m": 0.01356504272158301, - "reverse_rotation_deg": 0.3255230434099281, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.650555275113579, - "heldout_inlier_rmse_m": 0.12104882943540958, - "rotation_invariant_error_deg": 0.1682852032564881, - "reverse_translation_m": 0.003583199374499245, - "reverse_rotation_deg": 0.03300207707174736, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.5698054068172914, - "heldout_inlier_rmse_m": 0.12858662743221627, - "rotation_invariant_error_deg": 0.7985328447718985, - "reverse_translation_m": 0.016001435752891854, - "reverse_rotation_deg": 0.11059625579949509, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.6420881321982974, - "heldout_inlier_rmse_m": 0.12414062948335584, - "rotation_invariant_error_deg": 0.9364144322989034, - "reverse_translation_m": 0.012369101516230236, - "reverse_rotation_deg": 0.018705060406060074, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.6972966112450819, - "heldout_inlier_rmse_m": 0.11680896213116294, - "rotation_invariant_error_deg": 0.9873386907551591, - "reverse_translation_m": 0.011410238767832601, - "reverse_rotation_deg": 0.04779713993430858, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.8749086479902558, - "heldout_inlier_rmse_m": 0.09521299965540617, - "rotation_invariant_error_deg": 0.7228372421050018, - "reverse_translation_m": 0.006159472215773642, - "reverse_rotation_deg": 0.014929948455572307, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "heldout_inlier_ratio": 0.7022030893897189, - "heldout_inlier_rmse_m": 0.11797995277580095, - "rotation_invariant_error_deg": 0.3408827465240982, - "reverse_translation_m": 0.008495008365045943, - "reverse_rotation_deg": 0.102782991447036, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.6955810147299509, - "heldout_inlier_rmse_m": 0.1145595612270532, - "rotation_invariant_error_deg": 1.7562842773469534, - "reverse_translation_m": 0.010228664633443074, - "reverse_rotation_deg": 0.03515966054944097, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.868300353819945, - "heldout_inlier_rmse_m": 0.10454213568084784, - "rotation_invariant_error_deg": 0.6514660625063096, - "reverse_translation_m": 0.0023750253827712867, - "reverse_rotation_deg": 0.010725047644197173, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "heldout_inlier_ratio": 0.7265456392027422, - "heldout_inlier_rmse_m": 0.10962529664062398, - "rotation_invariant_error_deg": 0.4847012071219652, - "reverse_translation_m": 0.008958927594995584, - "reverse_rotation_deg": 0.0304143851242741, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "heldout_inlier_ratio": 0.7120070334086913, - "heldout_inlier_rmse_m": 0.11868441290330693, - "rotation_invariant_error_deg": 1.1046128571505598, - "reverse_translation_m": 0.002571958018982041, - "reverse_rotation_deg": 0.05506919751152759, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.5918615984405458, - "heldout_inlier_rmse_m": 0.12229328437386527, - "rotation_invariant_error_deg": 1.2404842024499416, - "reverse_translation_m": 0.014273957859022303, - "reverse_rotation_deg": 0.25325650727956367, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.6694009445687298, - "heldout_inlier_rmse_m": 0.12443900216431929, - "rotation_invariant_error_deg": 0.4822313558358922, - "reverse_translation_m": 0.017895201000461415, - "reverse_rotation_deg": 0.10920228290609475, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.702887537993921, - "heldout_inlier_rmse_m": 0.11495230769293868, - "rotation_invariant_error_deg": 0.1634066191652046, - "reverse_translation_m": 0.013545291843393993, - "reverse_rotation_deg": 0.033466251783377816, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.7429531936901991, - "heldout_inlier_rmse_m": 0.11679524427533879, - "rotation_invariant_error_deg": 0.05085197471169067, - "reverse_translation_m": 0.00989411002791081, - "reverse_rotation_deg": 0.07786907370564648, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "heldout_inlier_ratio": 0.7209645010046886, - "heldout_inlier_rmse_m": 0.11716134583909153, - "rotation_invariant_error_deg": 0.26477152026834405, - "reverse_translation_m": 0.011654729311847106, - "reverse_rotation_deg": 0.13683586564190353, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.618922305764411, - "heldout_inlier_rmse_m": 0.11254196340939995, - "rotation_invariant_error_deg": 0.05549924909793447, - "reverse_translation_m": 0.03104786021350874, - "reverse_rotation_deg": 0.10375098145235381, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 18, - "heldout_inlier_ratio": 0.6890156918687589, - "heldout_inlier_rmse_m": 0.11084024896736888, - "rotation_invariant_error_deg": 0.06628387310021466, - "reverse_translation_m": 0.01556225520371614, - "reverse_rotation_deg": 0.02495881796886513, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 19, - "heldout_inlier_ratio": 0.8685060899826, - "heldout_inlier_rmse_m": 0.10135543575024519, - "rotation_invariant_error_deg": 0.3152201090321789, - "reverse_translation_m": 0.002952251383831446, - "reverse_rotation_deg": 0.02753369989560042, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.7697708305735859, - "heldout_inlier_rmse_m": 0.10648049893472207, - "rotation_invariant_error_deg": 0.2007356143443637, - "reverse_translation_m": 0.010582276181446382, - "reverse_rotation_deg": 0.039599051949106026, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.6293759512937596, - "heldout_inlier_rmse_m": 0.1095449771750205, - "rotation_invariant_error_deg": 0.25455213438723945, - "reverse_translation_m": 0.012240937390583118, - "reverse_rotation_deg": 0.060306184678878015, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.6827314510833881, - "heldout_inlier_rmse_m": 0.10834806615100012, - "rotation_invariant_error_deg": 0.45437520989985103, - "reverse_translation_m": 0.012418496053917759, - "reverse_rotation_deg": 0.11905018881098527, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 20, - "heldout_inlier_ratio": 0.5756313809779688, - "heldout_inlier_rmse_m": 0.1265759478434112, - "rotation_invariant_error_deg": 0.5067750738975718, - "reverse_translation_m": 0.012917057356045326, - "reverse_rotation_deg": 0.24042373011343365, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 20, - "heldout_inlier_ratio": 0.6234734541714874, - "heldout_inlier_rmse_m": 0.12775305804057488, - "rotation_invariant_error_deg": 0.038058886117724455, - "reverse_translation_m": 0.009237066767190358, - "reverse_rotation_deg": 0.22540488888099894, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.6596992097884272, - "heldout_inlier_rmse_m": 0.12147955429086157, - "rotation_invariant_error_deg": 0.33308699073502623, - "reverse_translation_m": 0.014725537493637062, - "reverse_rotation_deg": 0.1988422472286775, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.5739414499308958, - "heldout_inlier_rmse_m": 0.13255415786946786, - "rotation_invariant_error_deg": 0.49226728584470436, - "reverse_translation_m": 0.006040617548520927, - "reverse_rotation_deg": 0.19706632354687328, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.6456945156330087, - "heldout_inlier_rmse_m": 0.12075756038041646, - "rotation_invariant_error_deg": 0.40978574449533767, - "reverse_translation_m": 0.022949011013485506, - "reverse_rotation_deg": 0.1911210947924365, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7716237647919971, - "heldout_inlier_rmse_m": 0.11632271358541554, - "rotation_invariant_error_deg": 0.2029947674039514, - "reverse_translation_m": 0.00996357879827298, - "reverse_rotation_deg": 0.15332892195322273, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.8576224819696593, - "heldout_inlier_rmse_m": 0.09865676260631216, - "rotation_invariant_error_deg": 0.08196486868098773, - "reverse_translation_m": 0.0039225733250952055, - "reverse_rotation_deg": 0.00898487649368532, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.7715940569126165, - "heldout_inlier_rmse_m": 0.1136150455355286, - "rotation_invariant_error_deg": 0.49417528129087884, - "reverse_translation_m": 0.007475673605589086, - "reverse_rotation_deg": 0.042277690012993266, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.7396689147762109, - "heldout_inlier_rmse_m": 0.11702962848624102, - "rotation_invariant_error_deg": 0.07221906147911383, - "reverse_translation_m": 0.01814015943430581, - "reverse_rotation_deg": 0.11847321816106485, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.6983240223463687, - "heldout_inlier_rmse_m": 0.11898873157361621, - "rotation_invariant_error_deg": 0.6434012981205939, - "reverse_translation_m": 0.013438931050857202, - "reverse_rotation_deg": 0.08244161259412694, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.736861094407697, - "heldout_inlier_rmse_m": 0.11586394710110075, - "rotation_invariant_error_deg": 0.19913456977449506, - "reverse_translation_m": 0.018559552524775386, - "reverse_rotation_deg": 0.0645260279790244, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.7853164556962026, - "heldout_inlier_rmse_m": 0.1128725442321241, - "rotation_invariant_error_deg": 0.5709657470244167, - "reverse_translation_m": 0.002195759849115173, - "reverse_rotation_deg": 0.032112959181416705, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.6881127450980392, - "heldout_inlier_rmse_m": 0.12303206700403986, - "rotation_invariant_error_deg": 2.3734594630006525, - "reverse_translation_m": 0.004939188019100004, - "reverse_rotation_deg": 0.12964064637100806, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6852618757612667, - "heldout_inlier_rmse_m": 0.12040544972155913, - "rotation_invariant_error_deg": 0.1574826892383996, - "reverse_translation_m": 0.006032445250250899, - "reverse_rotation_deg": 0.14039335223024835, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.677667493796526, - "heldout_inlier_rmse_m": 0.12346315805814134, - "rotation_invariant_error_deg": 0.10001483417661916, - "reverse_translation_m": 0.02347922689116974, - "reverse_rotation_deg": 0.16273859629352566, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.6530209617755857, - "heldout_inlier_rmse_m": 0.12710147612984257, - "rotation_invariant_error_deg": 0.7149536911782102, - "reverse_translation_m": 0.013311199903818141, - "reverse_rotation_deg": 0.18193579850152686, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.6649014778325123, - "heldout_inlier_rmse_m": 0.1248115961442785, - "rotation_invariant_error_deg": 0.5126580224866935, - "reverse_translation_m": 0.017872821205486625, - "reverse_rotation_deg": 0.1680556511699705, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.9127837514934289, - "heldout_inlier_rmse_m": 0.0958142916589384, - "rotation_invariant_error_deg": 0.054012386376783184, - "reverse_translation_m": 0.003534148840172682, - "reverse_rotation_deg": 0.018440169300173608, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.8510739856801909, - "heldout_inlier_rmse_m": 0.10418150333394147, - "rotation_invariant_error_deg": 0.24124343828054862, - "reverse_translation_m": 0.006103232696002816, - "reverse_rotation_deg": 0.13366555345652814, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "heldout_inlier_ratio": 0.8853518429870751, - "heldout_inlier_rmse_m": 0.10761251229652005, - "rotation_invariant_error_deg": 0.31032271091986274, - "reverse_translation_m": 0.003483231665912094, - "reverse_rotation_deg": 0.0369774420199415, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.9183867141162515, - "heldout_inlier_rmse_m": 0.09074909570650921, - "rotation_invariant_error_deg": 0.15492424092203905, - "reverse_translation_m": 0.00040199505815422204, - "reverse_rotation_deg": 0.011554314408129918, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.8853200095170116, - "heldout_inlier_rmse_m": 0.10604184939655073, - "rotation_invariant_error_deg": 0.2535175622408232, - "reverse_translation_m": 0.007320240476189879, - "reverse_rotation_deg": 0.12930335868605478, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "heldout_inlier_ratio": 0.7880466815984911, - "heldout_inlier_rmse_m": 0.10871274240898265, - "rotation_invariant_error_deg": 0.6273264323501735, - "reverse_translation_m": 0.0063952430610542755, - "reverse_rotation_deg": 0.039517035902874385, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.9289448669201521, - "heldout_inlier_rmse_m": 0.0850509551532673, - "rotation_invariant_error_deg": 0.06642597183531862, - "reverse_translation_m": 0.005157655135591474, - "reverse_rotation_deg": 0.022666807877311387, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7872365477452019, - "heldout_inlier_rmse_m": 0.10455513464835667, - "rotation_invariant_error_deg": 0.4661735027920457, - "reverse_translation_m": 0.011650639607012138, - "reverse_rotation_deg": 0.1624719134077532, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.8000944621560987, - "heldout_inlier_rmse_m": 0.1086547547358129, - "rotation_invariant_error_deg": 0.3806425437120353, - "reverse_translation_m": 0.0011394164967304414, - "reverse_rotation_deg": 0.02119627748719656, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "heldout_inlier_ratio": 0.7465330381074466, - "heldout_inlier_rmse_m": 0.1066966653439246, - "rotation_invariant_error_deg": 0.22580828656688823, - "reverse_translation_m": 0.00635764905956918, - "reverse_rotation_deg": 0.040016615214377715, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "heldout_inlier_ratio": 0.7248812145092132, - "heldout_inlier_rmse_m": 0.10870831469083347, - "rotation_invariant_error_deg": 0.00452548507581696, - "reverse_translation_m": 0.00465638537716095, - "reverse_rotation_deg": 0.12465763189227934, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "heldout_inlier_ratio": 0.7243012243012243, - "heldout_inlier_rmse_m": 0.11138751941762699, - "rotation_invariant_error_deg": 0.6006586352807659, - "reverse_translation_m": 0.004263906321896464, - "reverse_rotation_deg": 0.046637396086304225, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "heldout_inlier_ratio": 0.6956070563818748, - "heldout_inlier_rmse_m": 0.1103354081949904, - "rotation_invariant_error_deg": 0.7369667173371113, - "reverse_translation_m": 0.011088061861347823, - "reverse_rotation_deg": 0.34561739459504637, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.8185562292643862, - "heldout_inlier_rmse_m": 0.0961579573295129, - "rotation_invariant_error_deg": 0.6089207032237525, - "reverse_translation_m": 0.004999163455591531, - "reverse_rotation_deg": 0.0213847958734735, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.8041343079031521, - "heldout_inlier_rmse_m": 0.099533431536842, - "rotation_invariant_error_deg": 0.7410181887106546, - "reverse_translation_m": 0.003171376495143, - "reverse_rotation_deg": 0.02376737774843464, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.8157085941946499, - "heldout_inlier_rmse_m": 0.09925944770258267, - "rotation_invariant_error_deg": 0.1261576421595052, - "reverse_translation_m": 0.004719596234887584, - "reverse_rotation_deg": 0.06146741991681224, - "accepted": true, - "rejection_reasons": [] - } - ] -} \ No newline at end of file diff --git a/results/02_data4_calibration/open3d_gicp/extrinsic.json b/results/02_data4_calibration/open3d_gicp/extrinsic.json deleted file mode 100644 index e0fae03..0000000 --- a/results/02_data4_calibration/open3d_gicp/extrinsic.json +++ /dev/null @@ -1,414 +0,0 @@ -{ - "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.2975484155117711, - -0.0014693441955134902, - 0.7052088406121522 - ], - "rotation_rpy_deg_xyz": [ - -0.8301548470744382, - 1.3787117674135543, - -0.9873301733452331 - ], - "quaternion_xyzw": [ - -0.007139952974435751, - 0.012092890421885221, - -0.008527968948116832, - 0.9998650192992987 - ], - "matrix_4x4": [ - [ - 0.9995620714937284, - 0.01688095033591077, - 0.02430429482463916, - 1.2975484155117711 - ], - [ - -0.017226321011659856, - 0.9997525896342856, - 0.014071722849138928, - -0.0014693441955134902 - ], - [ - -0.024060737635611132, - -0.014484234025182223, - 0.9996055661455342, - 0.7052088406121522 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 34, - "pairs": 42, - "residuals": { - "pairs": 42, - "translation_m": { - "rms": 0.12183423858445137, - "median": 0.060649486998667235, - "p90": 0.11912435755512873, - "p95": 0.3030566180355447, - "max": 0.45978165540815585 - }, - "rotation_deg": { - "rms": 1.0805282705084651, - "median": 0.7524132662595089, - "p90": 1.482445248533153, - "p95": 1.8550286425106393, - "max": 4.3358524167513774 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.038624527608401314, - "rotation_deg": 0.8023305035396044 - }, - { - "pair_index": 1, - "translation_m": 0.04180287320767011, - "rotation_deg": 0.6893264946463747 - }, - { - "pair_index": 2, - "translation_m": 0.019127950093528003, - "rotation_deg": 1.0042991942789465 - }, - { - "pair_index": 3, - "translation_m": 0.06137084310587195, - "rotation_deg": 0.3949193126839051 - }, - { - "pair_index": 4, - "translation_m": 0.1071111410675142, - "rotation_deg": 0.29878675978634545 - }, - { - "pair_index": 5, - "translation_m": 0.06364016847596804, - "rotation_deg": 0.5544336747047969 - }, - { - "pair_index": 6, - "translation_m": 0.06293697736756677, - "rotation_deg": 0.5686016770604462 - }, - { - "pair_index": 7, - "translation_m": 0.024970034635953178, - "rotation_deg": 0.5027938164737027 - }, - { - "pair_index": 8, - "translation_m": 0.06609908977135717, - "rotation_deg": 0.769573579451918 - }, - { - "pair_index": 9, - "translation_m": 0.015198604597359418, - "rotation_deg": 0.7395239518119227 - }, - { - "pair_index": 10, - "translation_m": 0.08603113369700931, - "rotation_deg": 0.38160978353264396 - }, - { - "pair_index": 11, - "translation_m": 0.023734833308603348, - "rotation_deg": 0.5279761588421565 - }, - { - "pair_index": 12, - "translation_m": 0.044728554479905425, - "rotation_deg": 0.8691250339782107 - }, - { - "pair_index": 13, - "translation_m": 0.07088160554682986, - "rotation_deg": 0.450151294217732 - }, - { - "pair_index": 14, - "translation_m": 0.08888554602585935, - "rotation_deg": 0.6592285262192215 - }, - { - "pair_index": 15, - "translation_m": 0.05233056995457292, - "rotation_deg": 1.8589142482602727 - }, - { - "pair_index": 16, - "translation_m": 0.12686760514047216, - "rotation_deg": 1.9773175636228766 - }, - { - "pair_index": 17, - "translation_m": 0.06853778836627006, - "rotation_deg": 0.2507622154612463 - }, - { - "pair_index": 18, - "translation_m": 0.0613281598931951, - "rotation_deg": 0.3396141740929532 - }, - { - "pair_index": 19, - "translation_m": 0.03461219125828727, - "rotation_deg": 0.5120113019840405 - }, - { - "pair_index": 20, - "translation_m": 0.003516478473153868, - "rotation_deg": 0.3641614482709119 - }, - { - "pair_index": 21, - "translation_m": 0.059970814104139375, - "rotation_deg": 0.61595189426212 - }, - { - "pair_index": 22, - "translation_m": 0.011156452422652521, - "rotation_deg": 0.39742394993610364 - }, - { - "pair_index": 23, - "translation_m": 0.04780738274324129, - "rotation_deg": 1.7812021332676105 - }, - { - "pair_index": 24, - "translation_m": 0.0580893770008635, - "rotation_deg": 0.879332260016813 - }, - { - "pair_index": 25, - "translation_m": 0.12024661823169551, - "rotation_deg": 4.3358524167513774 - }, - { - "pair_index": 26, - "translation_m": 0.06196910794842297, - "rotation_deg": 1.5238281010443262 - }, - { - "pair_index": 27, - "translation_m": 0.0503874055448458, - "rotation_deg": 0.972956387575872 - }, - { - "pair_index": 28, - "translation_m": 0.01757080571201053, - "rotation_deg": 0.8111658366205472 - }, - { - "pair_index": 29, - "translation_m": 0.032044188496992296, - "rotation_deg": 0.943436351113904 - }, - { - "pair_index": 30, - "translation_m": 0.05418626153418599, - "rotation_deg": 0.5111200883804832 - }, - { - "pair_index": 31, - "translation_m": 0.02622969795541729, - "rotation_deg": 0.26503765103607685 - }, - { - "pair_index": 32, - "translation_m": 0.10034938173040396, - "rotation_deg": 0.8910089412227198 - }, - { - "pair_index": 33, - "translation_m": 0.024232025179701657, - "rotation_deg": 0.2983628682948933 - }, - { - "pair_index": 34, - "translation_m": 0.06450981390919311, - "rotation_deg": 1.1099995759326005 - }, - { - "pair_index": 35, - "translation_m": 0.06841378002467255, - "rotation_deg": 0.765302580707095 - }, - { - "pair_index": 36, - "translation_m": 0.45978165540815585, - "rotation_deg": 0.8318777085643659 - }, - { - "pair_index": 37, - "translation_m": 0.31232972397739145, - "rotation_deg": 0.7893009066081454 - }, - { - "pair_index": 38, - "translation_m": 0.3910017597095041, - "rotation_deg": 0.6583887677988087 - }, - { - "pair_index": 39, - "translation_m": 0.1015358221759577, - "rotation_deg": 0.8428062435042994 - }, - { - "pair_index": 40, - "translation_m": 0.1090240114660279, - "rotation_deg": 0.8418950507797021 - }, - { - "pair_index": 41, - "translation_m": 0.03539906786781987, - "rotation_deg": 0.7658972874383352 - } - ] - } - }, - "ground": { - "planes": 34, - "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.007068161359903731, - 0.007140938677742994, - 0.00460528013456401 - ], - "rotation_deg": [ - 0.07009913972450056, - 0.0632417549466229, - 0.13781143232539678 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.8653146384480275, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 165.05915287927994, - "success": true, - "translation_m": 3.0576433724414325e-08, - "rotation_deg": 1.5435010182701515e-07 - }, - { - "cost": 165.05915287928036, - "success": true, - "translation_m": 3.132972747129673e-08, - "rotation_deg": 1.5835217811052665e-07 - }, - { - "cost": 165.0591528792959, - "success": true, - "translation_m": 5.032571008409966e-08, - "rotation_deg": 6.019987077228086e-07 - }, - { - "cost": 165.0591528792966, - "success": true, - "translation_m": 5.0134365128719625e-08, - "rotation_deg": 6.036593761377996e-07 - }, - { - "cost": 165.059152879271, - "success": true, - "translation_m": 4.0000992845476256e-09, - "rotation_deg": 5.9504483976085874e-08 - }, - { - "cost": 165.0591528792741, - "success": true, - "translation_m": 1.71650324878148e-08, - "rotation_deg": 2.1433774624387286e-07 - }, - { - "cost": 165.059152879271, - "success": true, - "translation_m": 3.8510946546090955e-09, - "rotation_deg": 5.7484467409642816e-08 - }, - { - "cost": 165.05915287927274, - "success": true, - "translation_m": 1.2609667860271796e-08, - "rotation_deg": 1.3972470982253386e-07 - }, - { - "cost": 165.05915287929693, - "success": true, - "translation_m": 5.0359957454032455e-08, - "rotation_deg": 6.053505895170472e-07 - }, - { - "cost": 165.05915287927098, - "success": true, - "translation_m": 0.0, - "rotation_deg": 0.0 - }, - { - "cost": 165.0591528792721, - "success": true, - "translation_m": 1.123025431013551e-08, - "rotation_deg": 3.014422244971439e-08 - }, - { - "cost": 165.0591528792711, - "success": true, - "translation_m": 2.4200230224271075e-09, - "rotation_deg": 6.741856490734345e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.0030749822448559927, - 0.0034380377435498433, - 0.0016315909218529902, - 0.07586073216888294, - 0.07187134364073751, - 0.11146702425116647 - ], - "p025": [ - 1.292007464312339, - -0.006797525226093335, - 0.701848741787294, - -0.9789682101604196, - 1.2351532937224006, - -1.211682139162798 - ], - "p975": [ - 1.3029347232892419, - 0.005407572756192536, - 0.7084594772174496, - -0.705679642362121, - 1.5258122853862286, - -0.8045746213351143 - ] - } -} \ No newline at end of file diff --git a/results/02_data4_calibration/small_gicp/B_estimation.npz b/results/02_data4_calibration/small_gicp/B_estimation.npz deleted file mode 100644 index db58307..0000000 Binary files a/results/02_data4_calibration/small_gicp/B_estimation.npz and /dev/null differ diff --git a/results/02_data4_calibration/small_gicp/B_quality.csv b/results/02_data4_calibration/small_gicp/B_quality.csv deleted file mode 100644 index c3cc963..0000000 --- a/results/02_data4_calibration/small_gicp/B_quality.csv +++ /dev/null @@ -1,156 +0,0 @@ -i,j,rtk_translation_m,rtk_rotation_deg,heldout_inlier_ratio,heldout_inlier_rmse_m,hessian_rank,hessian_condition,reverse_translation_m,reverse_rotation_deg,multistart_success_rate,accepted,rejection_reasons -0,1,1.8477087194158957,24.171297449440786,0.8193962748876044,0.11049677170760565,6,14.01384280930539,0.026680306344951596,0.12400141971813113,1.0,True, -0,2,2.633731568575307,80.09074797031298,0.7525388867463684,0.11492533799497681,6,14.962108606915407,0.0018465318763874656,0.03093450642761156,1.0,True, -0,3,6.923255970100826,79.91583883299243,0.628093901505486,0.12365050970311489,6,23.49058941554809,0.010524333328229862,0.23898233567763014,1.0,True, -0,4,2.952974950373882,130.25781950514033,0.693351593625498,0.11485738628517483,6,16.30512452170669,2.3214755241040135,1.4768350244766943,1.0,False,forward_reverse_translation;forward_reverse_rotation -0,5,8.205074921973447,88.82606603101337,0.6015065913370998,0.12959862169013578,6,26.276485388438196,0.013711901937629547,0.26024107991311357,1.0,True, -1,2,1.7155362084417105,55.91945052087219,0.7981310803891449,0.11167434332282761,6,13.484382276710292,0.050742368484802715,0.5170998105709517,1.0,False,forward_reverse_rotation -1,3,5.885389341942907,55.74454138355163,0.678820988438572,0.12109867185657652,6,27.478714016209608,0.008324315958289934,0.25689852176843175,1.0,True, -1,4,2.3031736807956613,106.08652205569953,0.6772473651580905,0.11157492180388107,6,13.25032679930311,0.00802452890723869,0.011334867255723058,1.0,True, -1,5,7.590375029412286,64.65476858157257,0.618779694923731,0.12786963556791484,6,21.376356908960595,0.012044684321695526,0.5185219918090508,1.0,False,forward_reverse_rotation -1,6,8.114848491620153,8.108983632525,0.6933789087226231,0.12162612003144421,6,23.560279629760274,0.008258211706006158,0.08942722541817279,1.0,True, -2,3,4.339151683168145,0.17490913732054883,0.7609663064208518,0.11583878636897658,6,13.299472485774093,0.00784220284106163,0.01711532312869618,1.0,True, -2,4,0.6150408096900305,50.167071534827386,0.796748976299789,0.11484342359047915,6,12.041666425070249,0.011210942709507262,0.11462542679280045,1.0,True, -2,5,5.894923525501676,8.735318060700383,0.7112112112112112,0.12001317983504071,6,15.619771158055366,0.011298647069299764,0.02158504824207679,1.0,True, -2,6,6.5470565092896145,47.810466888347186,0.7254529329785886,0.11794151013960824,6,22.73936753420594,0.004729020804343234,0.026463705119922912,1.0,True, -2,7,5.848768648120739,73.12203319515616,0.7569187603621987,0.11528530285715083,6,13.439936375510058,0.011994525026310043,0.05882394078371607,1.0,True, -3,4,3.9735035126146885,50.34198067214791,0.6957378664695738,0.11619002437046372,6,17.769677378118345,0.006018969660459514,0.057234124307389854,1.0,True, -3,5,2.3619393178889707,8.910227198020932,0.7989069680784996,0.1077590577814381,6,12.151555874812605,0.01353229173052898,0.06486032517688407,1.0,True, -3,6,2.2300116834828536,47.63555775102664,0.8435613682092555,0.11222309863990207,6,13.914901775514604,0.009512765198853305,0.09743636874085052,1.0,True, -3,7,2.450274232383144,72.94712405783562,0.8651898734177215,0.11184568072686094,6,12.975777248765134,0.010827690226297962,0.12520280777371934,1.0,True, -3,8,1.9936391786054533,163.56928836557165,0.825590155700653,0.10787987267070262,6,12.959410142765178,0.0056088079192386986,0.021536601402145895,1.0,True, -4,5,5.370771070097231,41.431753474126985,0.6652516676773802,0.12444356767629798,6,17.0278455355532,0.003155412913416372,0.05824374716659687,1.0,True, -4,6,6.142548765456278,97.97753842317456,0.6551681807021851,0.12030857820705748,6,24.380739297719824,0.011212969141455763,0.08373658947114908,0.5,True, -4,7,5.314106070657687,123.28910472998356,0.696936001976773,0.11799538994568655,6,16.89426071448657,0.00409529177569414,0.0519770010059835,0.5,True, -4,8,5.8981084980454765,146.08873096228052,0.7129198332924737,0.11349036082807595,6,18.616925126379197,0.01249802665331653,0.04549823831834878,1.0,True, -4,9,3.1650365894055956,158.11607430100375,0.6097234068478128,0.11677937926620108,6,25.94675052408701,0.00616984405743089,0.11548555225177864,0.5,True, -5,6,1.9357867378988893,56.54578494904757,0.7604901596732269,0.11101741624951145,6,16.791344333152654,0.01028641250952863,0.031127073736479716,1.0,True, -5,7,0.19501559913675365,81.85735125585654,0.8092687180764918,0.10777871969807898,6,15.20338641054919,0.010579714886860828,0.03333492483252218,1.0,True, -5,8,1.8038807059856978,172.47951556359365,0.7295760721789643,0.11311887218463837,6,17.053462425193878,0.009759205787181369,0.05935114015788255,1.0,True, -5,9,7.881613621164215,160.45217222486949,0.514987714987715,0.13057312144553648,6,36.76355827214787,0.013423709236357283,0.8456480282562385,1.0,False,forward_reverse_rotation -5,10,7.671857805815354,143.54232919109316,0.5442391832766165,0.13173165083201857,6,26.337222871823027,0.00523999417676037,0.17134499262937464,1.0,True, -6,7,2.130456053070114,25.311566306808988,0.8539354187689203,0.10462253085153163,6,12.502910766598342,0.002843314342407394,0.028424505305675103,1.0,True, -6,8,0.24494500622098103,115.93373061454483,0.7757757757757757,0.1131640002846509,6,15.521747346102597,0.007224674181694773,0.10395594559619498,1.0,True, -6,9,8.025985916230132,103.90638727582186,0.6009202835468226,0.1259448851291812,6,28.795189977892573,0.007975110549369148,0.07338758946554978,1.0,True, -6,10,8.303463402700086,159.91188585985975,0.5363513347275187,0.13083118553166714,6,31.167661263990606,1.7146158775247784,14.688249303878628,1.0,False,forward_reverse_translation;forward_reverse_rotation -6,11,11.328882063792355,138.54043874549896,0.4633337584491774,0.13769942152040132,6,58.377014583638996,0.023339879627157865,0.18888808553225306,1.0,True, -7,8,1.9962664218365056,90.62216430773583,0.8340050377833753,0.11132245152738919,6,16.170350777028464,0.004806949653405585,0.02034039865601464,1.0,True, -7,9,7.8811064994361235,78.59482096901284,0.6160971335586432,0.12637042711002067,6,24.17866477904224,0.012112046262530643,0.5927664140170301,1.0,False,forward_reverse_rotation -7,10,7.620696678413973,134.60031955305035,0.5721183607775164,0.13040415535689726,6,20.571872802604858,0.010507785715791607,0.10324111221368969,1.0,True, -7,11,10.356268683459426,113.22887243868989,0.5179098728976762,0.13593896500168,6,36.18276452817704,0.01570096854689765,0.062213006599939585,1.0,True, -7,12,13.76202076313695,94.9510481861355,0.419173636250156,0.14753718360891266,6,89.28960611274712,0.018245717875293024,0.41212759156893974,1.0,True, -8,9,7.803713858547152,12.027343338722998,0.6407549981373402,0.12189583104066963,6,28.06713348388497,0.025170709673794655,0.14112050756711447,1.0,True, -8,10,8.062504137991457,43.97815524531457,0.6075420709986488,0.12933255373443525,6,20.429632894689156,0.01256038832173067,0.12386976869589704,1.0,True, -8,11,11.084531710563947,22.606708130954026,0.5447599643448364,0.13547919137380177,6,27.72840331379869,0.006462771421800638,0.08629803406158434,1.0,True, -8,12,14.350449135419003,4.328883878399632,0.46489164086687307,0.14530908872417966,6,37.958964738084276,0.00955628888567663,0.1112688142308669,1.0,True, -8,13,18.245302761704593,28.43334478424675,0.37832991803278687,0.15442802982944018,6,101.4897081447731,0.027875630486669568,0.37387837894914167,1.0,True, -9,10,2.04815062353057,56.00549858403758,0.6576312576312576,0.10693844153477818,6,15.957672354569297,0.0038184479242649575,0.016135929192430513,0.5,True, -9,11,4.738677237611319,34.634051469677026,0.5883320678309288,0.11815838246331245,6,21.526672921842792,0.008866435423074387,0.05039949658393549,1.0,True, -9,12,7.170741483679294,16.35622721712263,0.5413589364844904,0.12469816852157387,6,38.0354745717217,0.03403608365914784,0.249719392637206,1.0,True, -9,13,10.733928030180744,16.40600144552375,0.5075728649611811,0.13356609480985904,6,50.3483756147633,0.0053243668825205025,0.1401976908512776,1.0,True, -9,14,7.8912187855633125,14.085282580602351,0.5416463116756228,0.12859551377809317,6,26.721469573230642,0.011377143482081005,0.045883349808202654,1.0,True, -10,11,3.2047552083250137,21.371447114360556,0.7131414267834794,0.12095106901516857,6,13.404202373771971,0.006897671932212844,0.18540056788520093,1.0,True, -10,12,6.291813977735496,39.64927136691496,0.6117876278616659,0.125002241212049,6,19.806559061723195,0.006509808900811586,0.06742381610992963,1.0,True, -10,13,10.199392557022867,72.41150002956134,0.5244808055380743,0.13689263771908436,6,36.18235272080672,0.0046518429660042555,0.17931102925270673,1.0,True, -10,14,6.819808471778838,41.920216003435236,0.5996858385693572,0.12955691635611957,6,17.916357473627098,0.009593578345611205,0.05753783232412823,1.0,True, -10,15,10.561163834622734,65.51298166784417,0.5048970366649924,0.13966622273060364,6,30.173625507677322,0.006074999657630774,0.04867559411570644,1.0,True, -11,12,3.467398797536633,18.277824252554396,0.6508076728924785,0.12017753597340274,6,15.211760062254479,0.016302173123952383,0.05141023051579345,1.0,True, -11,13,7.516502113110916,51.04005291520078,0.5666710199817161,0.12966061077144844,6,26.14207974844453,0.010250004424021303,0.0630753341579125,1.0,True, -11,14,3.767517331528496,20.548768889074672,0.64271407110666,0.12109534664165014,6,14.04589685067402,0.007610676428698485,0.05350102444543152,1.0,True, -11,15,7.712397127778454,44.141534553483616,0.570479416362689,0.12836105648377344,6,18.857231656557765,0.006898635416764969,0.028532809525243653,1.0,True, -11,16,11.0395297023812,69.98495270981527,0.4761423882857864,0.13515636052103228,6,45.4042112112498,0.037021121414326036,0.5129154434742894,1.0,False,forward_reverse_rotation -12,13,4.049286119591895,32.762228662646386,0.7056733087955325,0.11689859246507509,6,14.509757355016381,0.0020816591744367207,0.08889045467662131,1.0,True, -12,14,0.97948616772873,2.2709446365202806,0.8745432399512789,0.09766069029332589,6,11.857488007889668,0.002473515580842477,0.018069288085025077,1.0,True, -12,15,4.286747470271891,25.863710300929224,0.7033426183844012,0.12103901189560114,6,11.859397045728326,0.022780233796594867,0.04927694758545139,1.0,True, -12,16,7.5836501880550475,51.70712845726087,0.5820235756385069,0.12458133956199553,6,32.351864267271,0.00989839849833309,0.03808519306435704,1.0,True, -12,17,6.351478009829798,1.4248238883471207,0.6542219994988725,0.12658997093251892,6,11.229951110937455,0.019742680150836883,0.07899236042083516,1.0,True, -13,14,4.006260191078547,30.491284026126113,0.6984766461034874,0.11406275231178287,6,13.924718120717541,0.012533581961738958,0.10861604448395465,1.0,True, -13,15,0.9562774815922267,6.898518361717157,0.8794391298650243,0.09903209123829654,6,10.514819201987352,0.006638809913641406,0.04266354358349458,1.0,True, -13,16,3.565173336606111,18.944899794614482,0.7273073505141552,0.10958532316684438,6,19.40505650408657,0.005441055528592516,0.12519365495730794,1.0,True, -13,17,2.967150651379281,31.337404774299262,0.7130265716137395,0.11779895987026284,6,12.816390530620689,0.013263327701592687,0.16221305155705806,1.0,True, -13,18,5.249882044431148,3.4459964529377567,0.7019876443728176,0.11940768524727291,6,25.985486690964983,0.008995185113784413,0.05198334813202341,1.0,True, -14,15,4.019575892829469,23.592765664408944,0.7035920622959055,0.12189498753760801,6,10.295943232842452,0.010817230757509965,0.008099442158890762,0.5,True, -14,16,7.5676649485439835,49.43618382074059,0.5923489278752436,0.12241126089476961,6,33.65365690477826,0.003104373432332903,0.13386003286196627,1.0,True, -14,17,5.910977627463022,0.8461207481731591,0.6687795177728063,0.12452036369759786,6,8.95305147071513,0.01159286549234958,0.10132041390926738,1.0,True, -14,18,8.548241724186095,27.045287573188347,0.6196476790536196,0.12845393182350578,6,17.805505225184664,0.010070495463159433,0.13041926369959572,1.0,True, -14,19,9.249254057266956,79.47127430600668,0.5845660749506904,0.12584132662356784,6,30.335272352492872,0.016830803029542436,0.2574761671757917,1.0,True, -15,16,3.7301261399251735,25.84341815633164,0.7032674772036475,0.11602216892855616,6,22.696890954829907,0.0009988867448423883,0.09036168134112703,1.0,True, -15,17,2.2049738368271745,24.438886412582093,0.7489009568140678,0.11923375870790391,6,6.944925131742929,0.02582458487951314,0.095039680889365,1.0,True, -15,18,4.7000039832559155,3.452521908779401,0.7165438713998661,0.11783922962071142,6,19.334165264487982,0.009354386824208725,0.17478401338848865,1.0,True, -15,19,5.238340351181781,55.87850864159773,0.6924358974358974,0.11506895717743916,6,20.41712608461488,0.012497900854287812,0.3255615001296644,1.0,True, -15,20,2.0380809160783224,128.5450420215843,0.6751867872591427,0.11901811643083532,6,27.381712286843808,0.007126007329084919,0.09473387178666172,1.0,True, -16,17,3.368526196086246,50.282304568913744,0.6284461152882206,0.1113618900510703,6,25.184005110635376,0.015370940622322818,0.07520125332617648,1.0,True, -16,18,3.5240348999326185,22.39089624755224,0.6921281286473868,0.10919235768364483,6,39.42922894015919,0.005355462743716769,0.03654303027439279,1.0,True, -16,19,2.146829294717985,30.035090485266103,0.8880188913745961,0.0968346861370537,6,11.70909430755386,0.006745004702225108,0.04851926363283949,1.0,True, -16,20,4.728364693236263,102.70162386525263,0.6307301587301587,0.12362874516637085,6,35.70048091760535,0.007128919591300971,0.10475436005961275,1.0,True, -16,21,10.094336026449797,153.311489607007,0.40465918895599656,0.14174574821871383,6,57.2667389243621,0.01442382622115287,0.2621394134233604,1.0,True, -17,18,2.640403049812329,27.891408321361506,0.7665916015366274,0.11462276561713726,6,9.759321661407776,0.003676908482849856,0.03455537183665902,1.0,True, -17,19,3.933985934417215,80.31739505417984,0.645738203957382,0.11467441399973681,6,29.93502749301381,0.002658154417044598,0.03997293849541112,1.0,True, -17,20,4.2254212089887,152.98392843416656,0.6031375599636977,0.12542519992547976,6,27.708613247812377,4.543486491493239,1.5708713272202308,0.5,False,forward_reverse_translation;forward_reverse_rotation -17,21,9.21529677253323,156.40620582407942,0.4672368255565338,0.13751533766984328,6,32.19730123852794,0.13403735422224766,1.1805230479043929,0.5,False,forward_reverse_translation;forward_reverse_rotation -17,22,11.781237287606983,150.82966218116434,0.4255952380952381,0.1417851723285674,6,38.71155142811069,0.01638337185583796,0.14112774930143776,1.0,True, -18,19,2.4460967931915643,52.425986732818345,0.6999343401181878,0.10876407223187468,6,36.919102980185954,0.0029722527816906422,0.028553700929610463,1.0,True, -18,20,6.593931011285688,125.09252011280485,0.5796614723267061,0.12778176089815,6,32.46060078153023,0.0849644734357879,0.24110896992060843,1.0,False,forward_reverse_translation -18,21,11.793089868757727,175.70238585456048,0.42345743296016664,0.14463219993853524,6,41.677643204951686,0.008594432490503082,0.044791316017877565,1.0,True, -18,22,14.40479158879449,178.72107050256645,0.35586914688903143,0.14801012931814386,6,118.81863294454718,0.05364920712348454,0.15560820359743163,1.0,True, -18,23,11.744734461596845,164.11569663484164,0.3967277486910995,0.14073241205403209,6,67.8157115569044,0.0379980141073483,0.09667096210106078,1.0,True, -19,20,6.650720121741557,72.6665333799865,0.6260444787247719,0.12668491637849374,6,25.97982149253148,0.022781715838261912,0.19834674514582162,1.0,True, -19,21,12.053580264031138,123.27639912174077,0.3952850193339154,0.1421446220617431,6,61.553005632745744,0.01796074748252817,0.16263425635632095,1.0,True, -19,22,14.836246959975925,128.85294276465592,0.3237392373923739,0.15069330869045588,6,75.70505048512227,0.2579934626807855,1.1847082611411373,1.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation -19,23,11.740810561661805,143.45831663234065,0.37768025078369905,0.1432975121556299,6,38.93505210462392,0.07411982241929344,0.4458370864472602,1.0,True, -19,24,11.093516369446519,177.87107120383473,0.43504761904761907,0.13924446561169374,6,41.93660606132572,0.04258350776081339,0.7879276702809055,0.5,False,forward_reverse_rotation -20,21,5.40286046809103,50.60986574175429,0.6607188376242672,0.12214671257866079,6,14.082798146569438,0.01471691635641488,0.0747935794181239,1.0,True, -20,22,8.200956565000565,56.18640938466938,0.576328684508104,0.13245799460807672,6,16.034011252149995,0.02165175771302933,0.4612076789897289,1.0,True, -20,23,5.175118275082073,70.79178325235415,0.6451819579702717,0.12102263178677423,6,12.511468996120387,0.018249896901851893,0.12115759970382113,1.0,True, -20,24,4.710308396362637,105.20453782384023,0.7383177570093458,0.11441422046802802,6,12.152737785424229,0.009011279667019194,0.06430292411421322,1.0,True, -20,25,8.226491803107123,68.57831319871164,0.6182822702159718,0.12791257682460647,6,29.104161441720954,0.014703530260578728,0.32055535743282454,1.0,True, -21,22,2.8644847627909416,5.57654364291509,0.7740636818348177,0.11564788773425824,6,12.209574213097333,0.0065184199045192235,0.06991965908247275,1.0,True, -21,23,1.2936223973175418,20.18191751059984,0.862223327530465,0.10307116830776755,6,11.124499228103288,0.0026785916987678697,0.01879221122979615,1.0,True, -21,24,2.3128500583741403,54.59467208208593,0.7795265676152102,0.11182158240581822,6,15.934013426145448,0.003491995501356654,0.0374256510953578,1.0,True, -21,25,3.793272903723766,17.968447456957346,0.7340892465252378,0.12002239056891174,6,16.57216298005221,0.037735058311297705,0.2878144229712423,1.0,True, -21,26,4.631707245574304,60.912845043424184,0.7147358216190014,0.11997311573294966,6,17.372315653280065,0.012351932089198563,0.10379217190868555,1.0,True, -22,23,3.7194009250537223,14.605373867684753,0.7408951563458002,0.11726725109752717,6,12.610213323576254,0.009206244303295173,0.09601986001481369,1.0,True, -22,24,4.786117710081478,49.01812843917083,0.6936064556176288,0.11914624513148218,6,13.20338761495324,0.006090737153726605,0.027557138417491776,1.0,True, -22,25,2.3747421598149763,12.391903814042255,0.7356584485868911,0.11474070552638106,6,16.673633938013044,0.0019617091597581428,0.011643770804738128,1.0,True, -22,26,2.381693697571969,55.336301400509086,0.7422594142259414,0.11765221626900083,6,18.880420396501957,0.007814937371704293,0.039342553564881436,1.0,True, -22,27,2.9603952927690247,80.62067670375279,0.7254925373134329,0.11870181965154768,6,21.309389349405485,0.018241823604788005,0.08279236858582419,1.0,True, -23,24,1.0880644725336985,34.41275457148609,0.7884810126582279,0.10662565692629543,6,10.611199681165669,0.001882338148224756,0.020239211377623818,1.0,True, -23,25,5.033935954106079,2.213470053642494,0.6843137254901961,0.12171091934898426,6,15.150809064137142,0.014639828785635214,0.2046006298281892,1.0,True, -23,26,5.765534437288107,40.730927532824346,0.6772228989037758,0.12237954766026346,6,16.382334072569904,0.04518647006837157,0.20367965681897066,1.0,True, -23,27,6.392376191887118,66.01530283606805,0.6637469586374696,0.12340951265232122,6,20.64383986204732,0.010626193556947957,1.1817079481882757,1.0,False,forward_reverse_rotation -23,28,6.631292861991925,85.8775990418248,0.6720351390922401,0.12122778564083748,6,19.20657067904157,0.043540468687755365,0.26051478047218213,1.0,True, -24,25,6.097212810998921,36.62622462512857,0.6764267990074442,0.12367636388755719,6,21.50176872604179,0.035816405766439664,0.2046504337319023,1.0,True, -24,26,6.852918693116795,6.318172961338249,0.6524044389642417,0.12740232296321938,6,21.753053297058692,0.062038641373543625,0.12012273822228971,1.0,True, -24,27,7.47982907414204,31.60254826458195,0.6546798029556651,0.12425657449629145,6,26.295019203914197,0.05403266260962086,0.2126374478532415,1.0,True, -24,28,7.71913193400284,51.4648444703387,0.6614377470355731,0.12010155595807545,6,20.98500095492876,0.049490676797893776,0.25138526875505346,1.0,True, -24,29,7.213852273638132,93.73390958258973,0.6620579958399608,0.12331341986261203,6,28.045882177977884,0.08010108996241684,0.7934458070763889,1.0,False,forward_reverse_translation;forward_reverse_rotation -25,26,1.2882746074869595,42.944397586466835,0.9137395459976105,0.08148336624555251,6,16.56293455758718,0.0032405549728505064,0.006669174585592186,1.0,True, -25,27,1.7666235781584831,68.22877288971053,0.8596658711217183,0.1096145882030974,6,22.188153380460985,0.010624789877375215,0.04475651255674721,1.0,True, -25,28,2.1807182972588706,88.09106909546726,0.8839157491622786,0.10490699814192792,6,16.17217948348072,0.00283419137499405,0.01585308444597649,1.0,True, -25,29,1.118287177357716,130.36013420771832,0.7857227558401518,0.10954358768244267,6,20.132087187715307,0.003247718742817276,0.01654235380830592,1.0,True, -25,30,5.200639419572971,139.6773015481418,0.05061061531235322,0.1582745227634446,6,186.52424080569466,2.4401001990983833,2.63047633237589,0.0,False,heldout_inlier_ratio;forward_reverse_translation;forward_reverse_rotation;multistart_instability -26,27,0.6269948654714946,25.284375303243706,0.9188612099644128,0.07520973241900301,6,20.799051531446562,0.0009920873307779914,0.005485007138529723,1.0,True, -26,28,0.9431372257108486,45.14667150900044,0.9182726623840114,0.07611768518866212,6,21.99541958409829,0.004984978187527545,0.01173507098896779,1.0,True, -26,29,1.129925637779203,87.41573662125148,0.7856890251090416,0.10851393061782179,6,24.280602674778656,0.002586732426991948,0.12205883610743135,1.0,True, -26,30,4.786676837961511,177.3783008654109,0.7634835395750642,0.10495724850674527,6,34.80647378548578,0.008489213184554775,0.021733210949123293,1.0,True, -26,31,5.900105669197046,156.01119868987135,0.7374054682955207,0.1073752166304431,6,38.310555401782544,3.545322953478412,6.459518815762061,1.0,False,forward_reverse_translation;forward_reverse_rotation -27,28,0.44809323479571145,19.862296205756735,0.9281131178707225,0.07220943509634768,6,20.093208902964978,0.0023003913248606234,0.001591751329336308,1.0,True, -27,29,1.160064136065596,62.13136131800778,0.7871188037207112,0.10966659884725236,6,24.009650087098436,0.005134403698947268,0.02434844099203523,1.0,True, -27,30,4.25412615059095,152.09392556214777,0.7922108208955224,0.10147035321534553,6,32.52026042532504,2.795897032209197,3.237329131939042,1.0,False,forward_reverse_translation;forward_reverse_rotation -27,31,5.542871649427442,178.70442600700352,0.7592097617664149,0.10539218018667602,6,48.70669958381899,0.0020939062619997405,0.027400662783563425,1.0,True, -27,32,4.8829350360277,138.47370648510565,0.7480278422273782,0.10408734715846867,6,42.21510199826003,0.004407463145306061,0.03490543724836902,1.0,True, -28,29,1.5995723610319212,42.26906511225104,0.787814381863266,0.10901449493832843,6,25.913625419675043,0.01570175790237609,0.03569660498137675,1.0,True, -28,30,4.295353381127667,132.23162935639104,0.7791159962581852,0.10438560755009844,6,36.501677925790155,0.01170149615735483,0.047047156693309715,1.0,True, -28,31,5.754426930327516,158.8421298011293,0.7449015266285981,0.10668967013687296,6,48.04636971250818,0.024421374377245158,0.6810283060803514,0.5,False,forward_reverse_rotation -28,32,5.013331477001236,158.33600269086247,0.7309213587715216,0.1081318944415262,6,52.23779663520043,0.10324080390042788,0.9479198721286788,1.0,False,forward_reverse_translation;forward_reverse_rotation -28,33,5.317102997899902,67.05379893079937,0.6692465836255895,0.10871806386783629,6,54.67376255043738,0.13259351588266985,0.659391929056215,1.0,False,forward_reverse_translation;forward_reverse_rotation -29,30,4.099530130205247,89.96256424413995,0.7320662880982732,0.10929719051930432,6,30.745355096911158,0.005463604154015333,0.018583483487870766,1.0,True, -29,31,4.890018768530818,116.57306468887772,0.7254562254562255,0.11323336570178015,6,49.09678922599757,0.0050777995851252426,0.07265894091769333,1.0,True, -29,32,4.464737187763289,159.39493219688632,0.695837657096737,0.10999820041072961,6,72.25486343140591,0.011220553177198233,0.14599088546526143,1.0,True, -29,33,4.34670323578768,109.32286404305042,0.6382698298586149,0.11215583949685817,6,72.66655529463955,0.018977478007060265,0.05615608666616428,1.0,True, -30,31,2.3862917603439455,26.61050044473775,0.8286237272623269,0.0964659694513182,6,41.03513305025223,0.018905314487385798,0.08632503464137033,1.0,True, -30,32,1.1507634071714652,69.43236795274659,0.8065326633165829,0.09815063400019142,6,35.25635856167173,0.007341509941520892,0.023973741904832375,1.0,True, -30,33,2.4361832484951105,160.7145717128102,0.6965239055641239,0.10032655671840386,6,47.08947384000088,2.6257249086936962,3.1197630566421646,1.0,False,forward_reverse_translation;forward_reverse_rotation -31,32,1.2514382602180638,42.82186750800885,0.8146841206602162,0.09914628416022417,6,34.33173181492779,0.06936877058296162,0.45703051311645637,1.0,True, -31,33,0.641507519046697,134.10407126807203,0.7551430598250177,0.1003246191461096,6,28.537349904719164,0.005559091155811048,0.0330053182501105,1.0,True, -32,33,1.4370687242949811,91.2822037600631,0.043432078366576185,0.1661924920133195,6,88.4956235178996,0.946171384319174,3.5092968853566924,0.0,False,heldout_inlier_ratio;heldout_inlier_rmse;forward_reverse_translation;forward_reverse_rotation;multistart_instability diff --git a/results/02_data4_calibration/small_gicp/B_quality.json b/results/02_data4_calibration/small_gicp/B_quality.json deleted file mode 100644 index 7f661a2..0000000 --- a/results/02_data4_calibration/small_gicp/B_quality.json +++ /dev/null @@ -1,19969 +0,0 @@ -{ - "schema_version": 2, - "backend": "small_gicp", - "transform_convention": "B_ij=T_Li_Lj maps station j points into station i", - "raw_point_field": "points_raw", - "measured_extrinsic_used_as_initial": false, - "stations": 34, - "candidate_pairs": 155, - "accepted_pairs": 133, - "parameters": { - "command": "pairs", - "backend": "small_gicp", - "frames": "\\data4_prepared\\frames_all", - "body": "\\data4_prepared\\body_poses_rear_gga_raw_rear_to_front.csv", - "output": "results\\02_data4_calibration\\small_gicp\\B_estimation.npz", - "quality_json": "results\\02_data4_calibration\\small_gicp\\B_quality.json", - "quality_csv": "results\\02_data4_calibration\\small_gicp\\B_quality.csv", - "time_offset": 0.0, - "min_stations": 30, - "min_pairs": 20, - "min_gap": 1, - "max_gap": 5, - "min_translation": 0.5, - "min_rotation": 3.0, - "min_range": 2.0, - "max_range": 50.0, - "z_min": -0.6, - "z_max": 5.0, - "min_roi_points": 1000, - "holdout_fraction": 0.2, - "voxels": [ - 0.3, - 0.15, - 0.08 - ], - "correspondences": [ - 1.2, - 0.5, - 0.25 - ], - "iterations": 60, - "threads": 8, - "evaluation_distance": 0.25, - "min_inlier_ratio": 0.35, - "max_inlier_rmse": 0.16, - "max_hessian_condition": 100000000.0, - "reverse_translation_tolerance": 0.08, - "reverse_rotation_tolerance": 0.5, - "multistart": 2, - "multistart_translation_sigma": 0.3, - "multistart_rotation_sigma": 3.0, - "multistart_translation_tolerance": 0.08, - "multistart_rotation_tolerance": 0.5, - "min_multistart_success": 0.5, - "seed": 20260721 - }, - "accepted_loop_closure": { - "count": 204, - "translation_rms_m": 0.05535585175309386, - "translation_p95_m": 0.1115116379074081, - "rotation_rms_deg": 0.7065238289963304, - "rotation_p95_deg": 1.3657417416649225 - }, - "pairs": [ - { - "i": 0, - "j": 1, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784783905.353819, - "frame_counter_i": 382, - "frame_counter_j": 1182, - "rtk_translation_m": 1.8477087194158957, - "rtk_rotation_deg": 24.171297449440786, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9125981263771286, - 0.4087746109055665, - 0.008244829407349786, - 1.609483991564837 - ], - [ - -0.4088014793696517, - 0.9126215324852639, - 0.0018135350652826935, - -1.2615552121092464 - ], - [ - -0.006783081758140572, - -0.005025527161571208, - 0.9999643663044252, - 0.007918305352787577 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 9148, - "backend_objective": 925.5850309227212, - "backend_elapsed_sec": 0.3304098999942653, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4489, - "objective": 873.2318068011239 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 7401, - "objective": 985.1234245006173 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 9148, - "objective": 925.5850309227212 - } - ], - "heldout_symmetric": { - "evaluated": 7785, - "inliers": 6379, - "inlier_ratio": 0.8193962748876044, - "inlier_rmse_m": 0.11049677170760565, - "median_m": 0.10312860156857301, - "p90_m": 0.43216665589086356, - "p95_m": 0.6431893032606215 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 59129.030987988175, - 141835.53829922067, - 290431.2141896815, - 487284.4491534459, - 526614.1106785885, - 828624.9457322137 - ], - "effective_rank": 6, - "scaled_condition_number": 14.01384280930539, - "weakest_scaled_direction": [ - -0.008611429903847459, - 0.09949068386374309, - 0.0023060514298579486, - -0.46409753819566063, - 0.8753677187089856, - -0.09147109548427051 - ] - }, - "forward_reverse": { - "translation_m": 0.026680306344951596, - "rotation_deg": 0.12400141971813113 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.5257718890254282e-15, - "rotation_deg": 3.066809389089159e-14 - }, - { - "translation_m": 1.1185402273152979e-15, - "rotation_deg": 2.8015561028388492e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784783971.0503054, - "frame_counter_i": 382, - "frame_counter_j": 1839, - "rtk_translation_m": 2.633731568575307, - "rtk_rotation_deg": 80.09074797031298, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.18426548423554648, - 0.9828685104373209, - -0.003965162060012078, - 0.12828748804201265 - ], - [ - -0.9821009084969061, - 0.1839583434891191, - -0.04046150504235337, - -3.659471702290386 - ], - [ - -0.03903891454680426, - 0.011349848081003564, - 0.9991732302756845, - -0.07048425573871506 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8469, - "backend_objective": 932.0956168819439, - "backend_elapsed_sec": 0.23317170000518672, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4338, - "objective": 1043.2254570048926 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6813, - "objective": 719.7150187499116 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8469, - "objective": 932.0956168819439 - } - ], - "heldout_symmetric": { - "evaluated": 7779, - "inliers": 5854, - "inlier_ratio": 0.7525388867463684, - "inlier_rmse_m": 0.11492533799497681, - "median_m": 0.11888823104171088, - "p90_m": 0.7382134357650539, - "p95_m": 1.1900330298653434 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53808.45740554642, - 115133.385726355, - 169157.98498104126, - 433349.10199557134, - 587022.6537334354, - 805087.9836723672 - ], - "effective_rank": 6, - "scaled_condition_number": 14.962108606915407, - "weakest_scaled_direction": [ - -0.059301337748371014, - 0.0618270121704139, - 0.0024288157160767144, - -0.9855496669869919, - 0.11838117736011235, - -0.08563073928335065 - ] - }, - "forward_reverse": { - "translation_m": 0.0018465318763874656, - "rotation_deg": 0.03093450642761156 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6088660122137097e-15, - "rotation_deg": 8.159244233220607e-15 - }, - { - "translation_m": 4.436865193864425e-13, - "rotation_deg": 6.5763507935517475e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 382, - "frame_counter_j": 2726, - "rtk_translation_m": 6.923255970100826, - "rtk_rotation_deg": 79.91583883299243, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.18135208754517712, - 0.9833998431724239, - -0.006014049505849529, - 1.00962374311255 - ], - [ - -0.9827591582417957, - 0.18100330257526198, - -0.037712615246437764, - -7.910621242012589 - ], - [ - -0.03599801709655899, - 0.012749623731722724, - 0.9992705288658399, - -0.1131479049251044 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7200, - "backend_objective": 489.0994289127987, - "backend_elapsed_sec": 0.25339030000031926, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3908, - "objective": 972.5397997428759 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6140, - "objective": 697.6473636258237 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7200, - "objective": 489.0994289127987 - } - ], - "heldout_symmetric": { - "evaluated": 7838, - "inliers": 4923, - "inlier_ratio": 0.628093901505486, - "inlier_rmse_m": 0.12365050970311489, - "median_m": 0.1611449207266876, - "p90_m": 1.1299369194229054, - "p95_m": 1.6857992321503965 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 27903.088279234078, - 36451.67223560738, - 55909.88534318, - 213105.34497378222, - 343259.1475761004, - 655459.99019328 - ], - "effective_rank": 6, - "scaled_condition_number": 23.49058941554809, - "weakest_scaled_direction": [ - -0.9028878702374442, - 0.25066229932656925, - -0.029953556537140765, - -0.23237919716998515, - -0.051886535740285886, - -0.2537171378852663 - ] - }, - "forward_reverse": { - "translation_m": 0.010524333328229862, - "rotation_deg": 0.23898233567763014 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0403713898150154e-15, - "rotation_deg": 8.952591147592273e-15 - }, - { - "translation_m": 9.155133597044475e-16, - "rotation_deg": 3.38655375367174e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 4, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 382, - "frame_counter_j": 3621, - "rtk_translation_m": 2.952974950373882, - "rtk_rotation_deg": 130.25781950514033, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6476475632293136, - 0.7610364930282889, - -0.03709568872976496, - -1.3570028891787609 - ], - [ - -0.7602011277261135, - -0.6486905928097526, - -0.035982776492063835, - -3.8785521354018337 - ], - [ - -0.05144783034373829, - 0.0048960268928340345, - 0.9986636819638464, - -0.08071707267307117 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8047, - "backend_objective": 960.8982356674691, - "backend_elapsed_sec": 0.2555380999983754, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4415, - "objective": 995.1431994278853 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6643, - "objective": 840.4757049772511 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8047, - "objective": 960.8982356674691 - } - ], - "heldout_symmetric": { - "evaluated": 8032, - "inliers": 5569, - "inlier_ratio": 0.693351593625498, - "inlier_rmse_m": 0.11485738628517483, - "median_m": 0.13088700168222678, - "p90_m": 0.9218091524208296, - "p95_m": 1.354492368198559 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 45835.24985805154, - 112080.95011365153, - 130484.87191300928, - 298267.3222219178, - 537247.3122031885, - 747349.4564190693 - ], - "effective_rank": 6, - "scaled_condition_number": 16.30512452170669, - "weakest_scaled_direction": [ - -0.07488910133867964, - 0.021173407913573625, - 0.0015875708907936862, - -0.712814688943928, - -0.6927663592165134, - -0.07688159519901616 - ] - }, - "forward_reverse": { - "translation_m": 2.3214755241040135, - "rotation_deg": 1.4768350244766943 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.049271190539746e-15, - "rotation_deg": 3.1066337440483974e-15 - }, - { - "translation_m": 3.4220497415806435e-15, - "rotation_deg": 6.682872246605371e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 0, - "j": 5, - "lidar_time_i": 1784783825.357129, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 382, - "frame_counter_j": 4371, - "rtk_translation_m": 8.205074921973447, - "rtk_rotation_deg": 88.82606603101337, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.036498794675990334, - 0.9993158388908494, - -0.005974289001879268, - -0.9369116740785512 - ], - [ - -0.998566739701707, - 0.036235957795985055, - -0.03938809114582146, - -9.529070391608311 - ], - [ - -0.0391446592615627, - 0.0074033441420528695, - 0.9992061279569955, - -0.16997184679236196 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6879, - "backend_objective": 479.589248694357, - "backend_elapsed_sec": 0.2800021000148263, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3749, - "objective": 860.2201271321458 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5798, - "objective": 613.4067689784008 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6879, - "objective": 479.589248694357 - } - ], - "heldout_symmetric": { - "evaluated": 7965, - "inliers": 4791, - "inlier_ratio": 0.6015065913370998, - "inlier_rmse_m": 0.12959862169013578, - "median_m": 0.1773042442214013, - "p90_m": 1.44613985908007, - "p95_m": 2.1131854564918497 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 23277.98079913783, - 28610.078849637262, - 57734.907609341, - 134391.82333810086, - 263732.67635003163, - 611663.52234089 - ], - "effective_rank": 6, - "scaled_condition_number": 26.276485388438196, - "weakest_scaled_direction": [ - 0.03440417940301551, - -0.03973336609902496, - -0.003749411924063033, - 0.9933037360980752, - 0.029214457834631016, - 0.09857868570489119 - ] - }, - "forward_reverse": { - "translation_m": 0.013711901937629547, - "rotation_deg": 0.26024107991311357 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2411577700731207e-06, - "rotation_deg": 7.1051812670707434e-06 - }, - { - "translation_m": 1.9173458420030423e-15, - "rotation_deg": 8.145138298268245e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 2, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784783971.0503054, - "frame_counter_i": 1182, - "frame_counter_j": 1839, - "rtk_translation_m": 1.7155362084417105, - "rtk_rotation_deg": 55.91945052087219, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5702640432133582, - 0.8214463514480748, - -0.0049812358506465225, - -0.37347182826086966 - ], - [ - -0.8212044239585355, - 0.5699234492621486, - -0.028470266104582403, - -2.7846446470414015 - ], - [ - -0.02054787309877627, - 0.02032618197749117, - 0.9995822283520919, - -0.07351763499455538 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8899, - "backend_objective": 1260.3771436689235, - "backend_elapsed_sec": 0.26640120000229217, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4399, - "objective": 880.1341652279585 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7046, - "objective": 677.9067358195165 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8899, - "objective": 1260.3771436689235 - } - ], - "heldout_symmetric": { - "evaluated": 7812, - "inliers": 6235, - "inlier_ratio": 0.7981310803891449, - "inlier_rmse_m": 0.11167434332282761, - "median_m": 0.1043961904931863, - "p90_m": 0.5248354583355893, - "p95_m": 0.9460018103722176 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 64352.74081211555, - 116243.33514861012, - 160172.27419490964, - 308032.32191253814, - 601454.5575800784, - 867756.9576646221 - ], - "effective_rank": 6, - "scaled_condition_number": 13.484382276710292, - "weakest_scaled_direction": [ - 0.1086331200310428, - -0.06937800909820407, - 0.008673188306079476, - 0.9747630788842918, - -0.11910044305060002, - 0.13770380314161215 - ] - }, - "forward_reverse": { - "translation_m": 0.050742368484802715, - "rotation_deg": 0.5170998105709517 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4533775614978635e-15, - "rotation_deg": 9.930467138941337e-15 - }, - { - "translation_m": 8.158149256099716e-16, - "rotation_deg": 9.682187128603608e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 1, - "j": 3, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 1182, - "frame_counter_j": 2726, - "rtk_translation_m": 5.885389341942907, - "rtk_rotation_deg": 55.74454138355163, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5679059602473382, - 0.8229875260128184, - -0.013204254725284094, - 2.178453117101531 - ], - [ - -0.822632379122666, - 0.5669779216577895, - -0.04256765405324437, - -6.298543416126213 - ], - [ - -0.027546127396267456, - 0.035036671929786406, - 0.9990063275503078, - -0.09666259763547998 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7574, - "backend_objective": 498.08704089773306, - "backend_elapsed_sec": 0.27526229998329654, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4019, - "objective": 965.371478113488 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6347, - "objective": 638.3568163916656 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7574, - "objective": 498.08704089773306 - } - ], - "heldout_symmetric": { - "evaluated": 7871, - "inliers": 5343, - "inlier_ratio": 0.678820988438572, - "inlier_rmse_m": 0.12109867185657652, - "median_m": 0.14152252448187463, - "p90_m": 0.9536360823088159, - "p95_m": 1.4646456349434764 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24172.660580993655, - 39751.5424180105, - 64123.59619526433, - 131861.61042681473, - 350849.4900439128, - 664233.6271160279 - ], - "effective_rank": 6, - "scaled_condition_number": 27.478714016209608, - "weakest_scaled_direction": [ - 0.9721701864047402, - -0.21163208276291448, - 0.029842064473668113, - 0.012010927412879307, - 0.07578244896854729, - -0.057612493872120314 - ] - }, - "forward_reverse": { - "translation_m": 0.008324315958289934, - "rotation_deg": 0.25689852176843175 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.431499025786612e-15, - "rotation_deg": 7.54032382181622e-15 - }, - { - "translation_m": 3.955826839503363e-15, - "rotation_deg": 3.196236133011314e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 4, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 1182, - "frame_counter_j": 3621, - "rtk_translation_m": 2.3031736807956613, - "rtk_rotation_deg": 106.08652205569953, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.27957983069531067, - 0.9596739975938705, - -0.029341721329572322, - -1.6355702478603278 - ], - [ - -0.9583541849572967, - -0.2807884725114551, - -0.05210652434695195, - -3.597897620216403 - ], - [ - -0.05824409363374912, - 0.013551828175004483, - 0.9982103853947311, - -0.1300981939324638 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7721, - "backend_objective": 718.945055188074, - "backend_elapsed_sec": 0.41765899999882095, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 4284, - "objective": 765.9840185836492 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6397, - "objective": 568.3772079008166 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7721, - "objective": 718.945055188074 - } - ], - "heldout_symmetric": { - "evaluated": 8065, - "inliers": 5462, - "inlier_ratio": 0.6772473651580905, - "inlier_rmse_m": 0.11157492180388107, - "median_m": 0.12762272560377705, - "p90_m": 1.0355962798332152, - "p95_m": 1.5582970551014323 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53134.399566846485, - 66206.64566640113, - 70397.39517738722, - 203946.5430779024, - 477063.3338727754, - 704048.1585454656 - ], - "effective_rank": 6, - "scaled_condition_number": 13.25032679930311, - "weakest_scaled_direction": [ - -0.40453888738313803, - -0.04859784536243417, - -0.021436218321679558, - -0.5853066174884034, - -0.620437690736912, - -0.32557681428863744 - ] - }, - "forward_reverse": { - "translation_m": 0.00802452890723869, - "rotation_deg": 0.011334867255723058 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.677370212168891e-15, - "rotation_deg": 3.057866681311417e-14 - }, - { - "translation_m": 4.308824046522781e-16, - "rotation_deg": 3.5665276927786675e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 1, - "j": 5, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 1182, - "frame_counter_j": 4371, - "rtk_translation_m": 7.590375029412286, - "rtk_rotation_deg": 64.65476858157257, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4423345137417773, - 0.896725798967955, - -0.014933834675282106, - 1.0663469844514077 - ], - [ - -0.8966018964058622, - 0.4417590085102047, - -0.030887177946391366, - -8.583916327023964 - ], - [ - -0.02110017332243524, - 0.027052169328242327, - 0.9994113081311411, - -0.12449407001223341 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6831, - "backend_objective": 583.3387582515709, - "backend_elapsed_sec": 0.27231629999005236, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3734, - "objective": 1042.8123042748869 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5761, - "objective": 739.6838060038175 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6831, - "objective": 583.3387582515709 - } - ], - "heldout_symmetric": { - "evaluated": 7998, - "inliers": 4949, - "inlier_ratio": 0.618779694923731, - "inlier_rmse_m": 0.12786963556791484, - "median_m": 0.17137278288043206, - "p90_m": 1.1870386003170634, - "p95_m": 1.8889136574723122 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 28238.0852289698, - 34433.743997983, - 59904.435028640124, - 132278.82902109658, - 289188.16053904744, - 603627.3882801067 - ], - "effective_rank": 6, - "scaled_condition_number": 21.376356908960595, - "weakest_scaled_direction": [ - -0.11184647134105985, - 0.05115259084667171, - -0.007005960913332743, - -0.9859540039802402, - -0.03194138366606826, - -0.10816258990398264 - ] - }, - "forward_reverse": { - "translation_m": 0.012044684321695526, - "rotation_deg": 0.5185219918090508 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.978448892181099e-15, - "rotation_deg": 9.644804243470644e-15 - }, - { - "translation_m": 3.538792391074002e-07, - "rotation_deg": 2.84679803629782e-06 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 1, - "j": 6, - "lidar_time_i": 1784783905.353819, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 1182, - "frame_counter_j": 5145, - "rtk_translation_m": 8.114848491620153, - "rtk_rotation_deg": 8.108983632525, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9901859095753072, - 0.13975165667857892, - 0.0011571232063867275, - 3.680765954212872 - ], - [ - -0.13975270128876133, - 0.9901860499066577, - 0.0008769565238640183, - -7.405411158982142 - ], - [ - -0.0010232111299423143, - -0.0010300610870567503, - 0.9999989460060147, - -0.049129888185824706 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7635, - "backend_objective": 504.61016521511675, - "backend_elapsed_sec": 0.27115309998043813, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4120, - "objective": 940.9675105216816 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6457, - "objective": 599.8576761580636 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7635, - "objective": 504.61016521511675 - } - ], - "heldout_symmetric": { - "evaluated": 7899, - "inliers": 5477, - "inlier_ratio": 0.6933789087226231, - "inlier_rmse_m": 0.12162612003144421, - "median_m": 0.13882579038985704, - "p90_m": 0.7789919311960801, - "p95_m": 1.3197768971341812 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29392.501781799183, - 34476.17420216574, - 70679.52345490734, - 256351.0032776257, - 334389.3632440969, - 692495.5609974158 - ], - "effective_rank": 6, - "scaled_condition_number": 23.560279629760274, - "weakest_scaled_direction": [ - 0.5559722097702826, - -0.7852706399029713, - 0.0012960432067103916, - 0.1596355437191486, - -0.10341517697640891, - 0.19510263630705632 - ] - }, - "forward_reverse": { - "translation_m": 0.008258211706006158, - "rotation_deg": 0.08942722541817279 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.899114524108741e-16, - "rotation_deg": 2.394549914859817e-15 - }, - { - "translation_m": 9.586729210015212e-16, - "rotation_deg": 4.1137391856819014e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 3, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784059.7468228, - "frame_counter_i": 1839, - "frame_counter_j": 2726, - "rtk_translation_m": 4.339151683168145, - "rtk_rotation_deg": 0.17490913732054883, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999942699015206, - 0.0033852635401801128, - -1.2445459718489256e-05, - 4.333063289815064 - ], - [ - -0.0033852786535696648, - 0.9999930922990801, - -0.00153467995421118, - 0.08489590026183398 - ], - [ - 7.250077654139208e-06, - 0.0015347132916930235, - 0.9999988223005811, - 0.07295896317659771 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8587, - "backend_objective": 856.0715475024649, - "backend_elapsed_sec": 0.21810389999882318, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4309, - "objective": 1092.9351938432587 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7052, - "objective": 788.8250774559538 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8587, - "objective": 856.0715475024649 - } - ], - "heldout_symmetric": { - "evaluated": 7865, - "inliers": 5985, - "inlier_ratio": 0.7609663064208518, - "inlier_rmse_m": 0.11583878636897658, - "median_m": 0.11597829185554752, - "p90_m": 0.5973270988674076, - "p95_m": 0.9803465040544063 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 60122.366066792594, - 66116.53641011147, - 171595.85762173674, - 449428.6277738331, - 522163.18503998395, - 799595.7532849461 - ], - "effective_rank": 6, - "scaled_condition_number": 13.299472485774093, - "weakest_scaled_direction": [ - -0.2849548318491117, - 0.06824523530051936, - 0.006234854987810354, - -0.9503829447306366, - 0.09048009226723176, - -0.05186588007871201 - ] - }, - "forward_reverse": { - "translation_m": 0.00784220284106163, - "rotation_deg": 0.01711532312869618 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.836601059614785e-16, - "rotation_deg": 3.41063218999891e-15 - }, - { - "translation_m": 2.37502359079444e-13, - "rotation_deg": 5.522506562167771e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 1839, - "frame_counter_j": 3621, - "rtk_translation_m": 0.6150408096900305, - "rtk_rotation_deg": 50.167071534827386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6290828243794595, - 0.7773266084656674, - -0.004259558900319325, - -0.07621676503688517 - ], - [ - -0.777260708762794, - 0.6289331938752699, - -0.01757351004813966, - -1.5068897974764908 - ], - [ - -0.010981378980880044, - 0.014365981105223549, - 0.9998365005852522, - -0.06346997696192133 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 9254, - "backend_objective": 2072.3958582293526, - "backend_elapsed_sec": 0.3460661999997683, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4723, - "objective": 813.4360858542922 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7492, - "objective": 690.7974819308214 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 9254, - "objective": 2072.3958582293526 - } - ], - "heldout_symmetric": { - "evaluated": 8059, - "inliers": 6421, - "inlier_ratio": 0.796748976299789, - "inlier_rmse_m": 0.11484342359047915, - "median_m": 0.11118234619542774, - "p90_m": 0.47119981023226915, - "p95_m": 0.7568246620211112 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 72652.97771722807, - 265442.77925389394, - 338966.21054632735, - 531116.4377634256, - 646142.3713620297, - 874862.9224589223 - ], - "effective_rank": 6, - "scaled_condition_number": 12.041666425070249, - "weakest_scaled_direction": [ - -0.05150819311963626, - 0.0048259818320180725, - 0.004054125957658555, - -0.7192534425710625, - -0.6927756416048727, - 0.0066011932450483505 - ] - }, - "forward_reverse": { - "translation_m": 0.011210942709507262, - "rotation_deg": 0.11462542679280045 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2159359137519293e-16, - "rotation_deg": 1.8073954534709845e-14 - }, - { - "translation_m": 3.2159359137519293e-16, - "rotation_deg": 7.124131932641092e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 5, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 1839, - "frame_counter_j": 4371, - "rtk_translation_m": 5.894923525501676, - "rtk_rotation_deg": 8.735318060700383, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9889080800989196, - 0.14849643879107052, - 0.0031010935877352173, - 5.576686585894074 - ], - [ - -0.14849080684774918, - 0.9889118161680467, - -0.0019748733936760057, - -2.128406640853887 - ], - [ - -0.0033599697579784374, - 0.0014924843672253902, - 0.9999932415239812, - 0.0893816263911876 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7992, - "backend_objective": 818.2560074086199, - "backend_elapsed_sec": 0.3050091000040993, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4103, - "objective": 875.0728423878306 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6483, - "objective": 770.6464926720075 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7992, - "objective": 818.2560074086199 - } - ], - "heldout_symmetric": { - "evaluated": 7992, - "inliers": 5684, - "inlier_ratio": 0.7112112112112112, - "inlier_rmse_m": 0.12001317983504071, - "median_m": 0.13295490000749227, - "p90_m": 0.7598164437148195, - "p95_m": 1.2751449641484631 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43664.47319558568, - 72543.82818908544, - 146201.22719238102, - 301046.72712777543, - 426999.7180266239, - 682029.0790520908 - ], - "effective_rank": 6, - "scaled_condition_number": 15.619771158055366, - "weakest_scaled_direction": [ - -0.06912375615627211, - 0.025181210662304124, - -0.004005521569876777, - -0.9964863566115368, - -0.03260316362698907, - -0.02288544449991913 - ] - }, - "forward_reverse": { - "translation_m": 0.011298647069299764, - "rotation_deg": 0.02158504824207679 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2884146304124796e-07, - "rotation_deg": 9.728381509807967e-07 - }, - { - "translation_m": 3.888257972851056e-16, - "rotation_deg": 6.00787833770186e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 6, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 1839, - "frame_counter_j": 5145, - "rtk_translation_m": 6.5470565092896145, - "rtk_rotation_deg": 47.810466888347186, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.679607543043412, - -0.7331071876051084, - -0.02621905643278578, - 6.106807104650168 - ], - [ - 0.733558982397586, - 0.6794003353205805, - 0.017504391166282395, - 0.7002711803942592 - ], - [ - 0.004980640753570885, - -0.03112934062924716, - 0.9995029551580485, - 0.11411103758893074 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 8220, - "backend_objective": 814.9787693610598, - "backend_elapsed_sec": 0.23136229999363422, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4254, - "objective": 947.8982151389088 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6874, - "objective": 693.1863685911549 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 8220, - "objective": 814.9787693610598 - } - ], - "heldout_symmetric": { - "evaluated": 7893, - "inliers": 5726, - "inlier_ratio": 0.7254529329785886, - "inlier_rmse_m": 0.11794151013960824, - "median_m": 0.12559233854459917, - "p90_m": 0.690575598333221, - "p95_m": 1.233371965878733 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33462.004282357586, - 45754.60231662486, - 119903.75846890768, - 284155.69505675446, - 455801.7573525642, - 760904.8138077022 - ], - "effective_rank": 6, - "scaled_condition_number": 22.73936753420594, - "weakest_scaled_direction": [ - -0.5757045971727006, - 0.8083689469310571, - 0.0031816263247047873, - -0.058901349073318544, - -0.05104603613026958, - 0.09496669394294326 - ] - }, - "forward_reverse": { - "translation_m": 0.004729020804343234, - "rotation_deg": 0.026463705119922912 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1102230246251565e-16, - "rotation_deg": 1.1877367235973417e-14 - }, - { - "translation_m": 2.0469737016526324e-15, - "rotation_deg": 2.3599702469516848e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 7, - "lidar_time_i": 1784783971.0503054, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 1839, - "frame_counter_j": 6006, - "rtk_translation_m": 5.848768648120739, - "rtk_rotation_deg": 73.12203319515616, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3006040225830624, - -0.9533810275890214, - -0.026492222258313082, - 4.516991468811158 - ], - [ - 0.9537490189394499, - 0.3004829439382328, - 0.008532835065217377, - -0.877901707004186 - ], - [ - -0.000174582127080686, - -0.027831935533034088, - 0.9996126014039471, - 0.07024498912604761 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8602, - "backend_objective": 1069.0019960130649, - "backend_elapsed_sec": 0.28784810000797734, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4404, - "objective": 1580.9634624997295 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7053, - "objective": 853.7741832339575 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8602, - "objective": 1069.0019960130649 - } - ], - "heldout_symmetric": { - "evaluated": 7841, - "inliers": 5935, - "inlier_ratio": 0.7569187603621987, - "inlier_rmse_m": 0.11528530285715083, - "median_m": 0.11929042652918181, - "p90_m": 0.5949135774640592, - "p95_m": 1.0173779799268166 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 55965.556518478406, - 79682.01027441541, - 191552.95561020085, - 508354.9613065142, - 552170.9303599342, - 752173.518828362 - ], - "effective_rank": 6, - "scaled_condition_number": 13.439936375510058, - "weakest_scaled_direction": [ - -0.042623718185682676, - 0.0406623692919027, - 0.011640945315802658, - 0.176259184710576, - -0.9807109261989321, - 0.059439530642041626 - ] - }, - "forward_reverse": { - "translation_m": 0.011994525026310043, - "rotation_deg": 0.05882394078371607 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.929792726436376e-16, - "rotation_deg": 5.5004508349214495e-15 - }, - { - "translation_m": 5.7642290025260994e-15, - "rotation_deg": 3.473191958692075e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784149.2434597, - "frame_counter_i": 2726, - "frame_counter_j": 3621, - "rtk_translation_m": 3.9735035126146885, - "rtk_rotation_deg": 50.34198067214791, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6317826050962754, - 0.7751274010635448, - -0.005315262762812435, - -4.392524912649905 - ], - [ - -0.7749169413246866, - 0.6314148152680543, - -0.028619313548737965, - -1.6018978130059436 - ], - [ - -0.018827478475773568, - 0.02220007163238442, - 0.999576251655551, - -0.11203743690185429 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7746, - "backend_objective": 764.2179390458136, - "backend_elapsed_sec": 0.29167679999955, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4500, - "objective": 930.7151403888046 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6659, - "objective": 669.8774540091324 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7746, - "objective": 764.2179390458136 - } - ], - "heldout_symmetric": { - "evaluated": 8118, - "inliers": 5648, - "inlier_ratio": 0.6957378664695738, - "inlier_rmse_m": 0.11619002437046372, - "median_m": 0.1306868403333145, - "p90_m": 0.8673560181965742, - "p95_m": 1.321002184414254 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43822.80846199571, - 48057.061925362636, - 122675.43469925378, - 245703.9302869912, - 649349.6183279632, - 778717.1681727384 - ], - "effective_rank": 6, - "scaled_condition_number": 17.769677378118345, - "weakest_scaled_direction": [ - 0.4275526555866418, - 0.33255436336907923, - 0.011680211870989552, - -0.6096467399635787, - -0.5219889368925024, - -0.24965635775854209 - ] - }, - "forward_reverse": { - "translation_m": 0.006018969660459514, - "rotation_deg": 0.057234124307389854 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.88411095042053e-15, - "rotation_deg": 4.1321581381786235e-15 - }, - { - "translation_m": 9.535363269142996e-16, - "rotation_deg": 5.299246052064489e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 5, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 2726, - "frame_counter_j": 4371, - "rtk_translation_m": 2.3619393178889707, - "rtk_rotation_deg": 8.910227198020932, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9893982103948105, - 0.14520885224472682, - -0.002360190101662168, - 1.2315298807919002 - ], - [ - -0.14521711564298428, - 0.989392442510526, - -0.0038189039511107126, - -2.2059485326979678 - ], - [ - 0.0017806155898990599, - 0.004121156733831111, - 0.9999899226868719, - -0.04251477640004765 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 9081, - "backend_objective": 1099.02857099634, - "backend_elapsed_sec": 0.2541962999966927, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4292, - "objective": 786.4461680914845 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7015, - "objective": 673.9496249417359 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 9081, - "objective": 1099.02857099634 - } - ], - "heldout_symmetric": { - "evaluated": 8051, - "inliers": 6432, - "inlier_ratio": 0.7989069680784996, - "inlier_rmse_m": 0.1077590577814381, - "median_m": 0.0992503950794747, - "p90_m": 0.497401795766372, - "p95_m": 0.7191295322528828 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 63669.100211894445, - 122628.58457622542, - 312225.14596344164, - 512488.84409043816, - 588006.4146637795, - 773678.6287238784 - ], - "effective_rank": 6, - "scaled_condition_number": 12.151555874812605, - "weakest_scaled_direction": [ - 0.027307597765790118, - -0.0461349678648937, - -0.0030753359845690697, - 0.9981276090766803, - 0.02864736034558914, - -0.006083329437762221 - ] - }, - "forward_reverse": { - "translation_m": 0.01353229173052898, - "rotation_deg": 0.06486032517688407 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3784667683267003e-15, - "rotation_deg": 5.235678387664452e-15 - }, - { - "translation_m": 1.3847223016301615e-15, - "rotation_deg": 4.449207215945554e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 2726, - "frame_counter_j": 5145, - "rtk_translation_m": 2.2300116834828536, - "rtk_rotation_deg": 47.63555775102664, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.67709207194386, - -0.7354856262118965, - -0.024641829202908194, - 1.7745705825908622 - ], - [ - 0.7357999079681138, - 0.6771694618675113, - 0.006325768584300728, - 0.6277320504546843 - ], - [ - 0.01203418235226848, - -0.022414583417047322, - 0.9996763300715655, - 0.051454602337922074 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 9640, - "backend_objective": 1324.5318215061093, - "backend_elapsed_sec": 0.28068219998385757, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4385, - "objective": 850.2055960686419 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7544, - "objective": 944.528287827637 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 9640, - "objective": 1324.5318215061093 - } - ], - "heldout_symmetric": { - "evaluated": 7952, - "inliers": 6708, - "inlier_ratio": 0.8435613682092555, - "inlier_rmse_m": 0.11222309863990207, - "median_m": 0.09985002373567062, - "p90_m": 0.3472719337003683, - "p95_m": 0.6263514571056615 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 66093.02239897958, - 75656.89005478329, - 234043.8065575262, - 426965.29563004465, - 666843.604976733, - 919677.9147286874 - ], - "effective_rank": 6, - "scaled_condition_number": 13.914901775514604, - "weakest_scaled_direction": [ - -0.06747562450273357, - -0.08028438637478795, - -0.01014254984946794, - 0.5823576455471786, - -0.8058988638203852, - 0.01688727481567722 - ] - }, - "forward_reverse": { - "translation_m": 0.009512765198853305, - "rotation_deg": 0.09743636874085052 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 7.499464594287265e-16, - "rotation_deg": 1.1388783981579358e-14 - }, - { - "translation_m": 7.411310411386368e-16, - "rotation_deg": 2.2093305098138265e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 7, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 2726, - "frame_counter_j": 6006, - "rtk_translation_m": 2.450274232383144, - "rtk_rotation_deg": 72.94712405783562, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.29750555994608924, - -0.954356501241259, - -0.026345973880412904, - 0.18064584180701715 - ], - [ - 0.9547059445146591, - 0.2972376618624461, - 0.013650343545833549, - -0.9662070068219294 - ], - [ - -0.005196278431439895, - -0.029213710977717827, - 0.9995596819506946, - 0.0526388063859415 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9707, - "backend_objective": 1925.8736714572685, - "backend_elapsed_sec": 0.26173430000199005, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4478, - "objective": 901.8597500613186 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7536, - "objective": 906.9466459753235 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9707, - "objective": 1925.8736714572685 - } - ], - "heldout_symmetric": { - "evaluated": 7900, - "inliers": 6835, - "inlier_ratio": 0.8651898734177215, - "inlier_rmse_m": 0.11184568072686094, - "median_m": 0.09777937779985399, - "p90_m": 0.30794231021079616, - "p95_m": 0.5884625201365746 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68960.67232667019, - 134669.02712657556, - 239610.41123137888, - 402189.01429493976, - 810013.9197832796, - 894818.3230359544 - ], - "effective_rank": 6, - "scaled_condition_number": 12.975777248765134, - "weakest_scaled_direction": [ - -0.07341355859242478, - -0.016624375753157422, - -0.014165459083398455, - 0.18433866396576204, - -0.9797054408146324, - 0.01816385201700405 - ] - }, - "forward_reverse": { - "translation_m": 0.010827690226297962, - "rotation_deg": 0.12520280777371934 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.428971209373367e-16, - "rotation_deg": 7.468673804681556e-15 - }, - { - "translation_m": 6.886305980398687e-16, - "rotation_deg": 4.907815366160238e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 8, - "lidar_time_i": 1784784059.7468228, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 2726, - "frame_counter_j": 6878, - "rtk_translation_m": 1.9936391786054533, - "rtk_rotation_deg": 163.56928836557165, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9584723349348874, - -0.2809125906691351, - -0.0491823095027087, - -0.6000371984860277 - ], - [ - 0.28213214547205395, - -0.9591717928748923, - -0.01977180428036556, - -0.03071934600768833 - ], - [ - -0.04162013522084039, - -0.03282663791374737, - 0.9985940998160759, - -0.031271634276991124 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9352, - "backend_objective": 1390.9125260940514, - "backend_elapsed_sec": 0.2632891999965068, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4350, - "objective": 731.216867716811 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7289, - "objective": 972.051009810749 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9352, - "objective": 1390.9125260940514 - } - ], - "heldout_symmetric": { - "evaluated": 7964, - "inliers": 6575, - "inlier_ratio": 0.825590155700653, - "inlier_rmse_m": 0.10787987267070262, - "median_m": 0.09740790038508482, - "p90_m": 0.4161748314222322, - "p95_m": 0.8411795615121116 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 73425.87460077305, - 111589.29592121772, - 209223.73122451387, - 450215.0745205711, - 922500.2501722764, - 951556.0240426623 - ], - "effective_rank": 6, - "scaled_condition_number": 12.959410142765178, - "weakest_scaled_direction": [ - -0.04892400816475284, - 0.08106406285957779, - -0.0011096859706196036, - -0.9801047124872695, - -0.17395946256606523, - -0.012910680803605518 - ] - }, - "forward_reverse": { - "translation_m": 0.0056088079192386986, - "rotation_deg": 0.021536601402145895 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.650741990671528e-16, - "rotation_deg": 3.5054248032768868e-15 - }, - { - "translation_m": 9.350958321038125e-16, - "rotation_deg": 1.200625963401235e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784224.2408776, - "frame_counter_i": 3621, - "frame_counter_j": 4371, - "rtk_translation_m": 5.370771070097231, - "rtk_rotation_deg": 41.431753474126985, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7374659969389349, - -0.6752644377386929, - -0.012721732755800672, - 4.019843316779792 - ], - [ - 0.675383271270438, - 0.7373017858395939, - 0.015604918640872895, - 3.9859783604748 - ], - [ - -0.0011576903321611819, - -0.02010014236748322, - 0.9997973014716045, - 0.09109239938318082 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7645, - "backend_objective": 1056.9446442627448, - "backend_elapsed_sec": 0.2659155000001192, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4090, - "objective": 858.9660576080098 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6283, - "objective": 721.2220380460718 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7645, - "objective": 1056.9446442627448 - } - ], - "heldout_symmetric": { - "evaluated": 8245, - "inliers": 5485, - "inlier_ratio": 0.6652516676773802, - "inlier_rmse_m": 0.12444356767629798, - "median_m": 0.1507694842440363, - "p90_m": 0.9728378708380272, - "p95_m": 1.5110915609833526 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38052.42667159524, - 85012.15121452378, - 159271.63518174115, - 302194.9536642637, - 485374.66931093106, - 647950.8436168886 - ], - "effective_rank": 6, - "scaled_condition_number": 17.0278455355532, - "weakest_scaled_direction": [ - -0.002403626452954274, - -0.021700868900574353, - -0.002374023859786528, - 0.9993912833974224, - 0.019256749864934933, - 0.01907614042305581 - ] - }, - "forward_reverse": { - "translation_m": 0.003155412913416372, - "rotation_deg": 0.05824374716659687 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.26712627438548e-07, - "rotation_deg": 3.535739034654156e-06 - }, - { - "translation_m": 6.267126280294208e-07, - "rotation_deg": 3.53573904247501e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 6, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 3621, - "frame_counter_j": 5145, - "rtk_translation_m": 6.142548765456278, - "rtk_rotation_deg": 97.97753842317456, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.14229570842138864, - -0.9882693919755955, - -0.05545755357967844, - 2.1761112016551567 - ], - [ - 0.9895389699740372, - -0.14337618163308116, - 0.015996794773976683, - 6.189580459141358 - ], - [ - -0.02376043491980259, - -0.05260113520168032, - 0.9983328915286303, - 0.1279515644779054 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7592, - "backend_objective": 598.5505091587456, - "backend_elapsed_sec": 0.3208908000087831, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 33, - "num_inliers": 4058, - "objective": 962.4915677611875 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6373, - "objective": 643.3430473354808 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7592, - "objective": 598.5505091587456 - } - ], - "heldout_symmetric": { - "evaluated": 8146, - "inliers": 5337, - "inlier_ratio": 0.6551681807021851, - "inlier_rmse_m": 0.12030857820705748, - "median_m": 0.14646410705918078, - "p90_m": 1.1055559769962546, - "p95_m": 1.6731341122978325 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33023.60306441301, - 37755.00907861605, - 65103.603795172334, - 169801.5569909478, - 443927.4351391484, - 805139.856984835 - ], - "effective_rank": 6, - "scaled_condition_number": 24.380739297719824, - "weakest_scaled_direction": [ - -0.02318604817580618, - -0.11064884812677978, - -0.014082402317942269, - 0.5740007998299039, - -0.8046677893199408, - 0.1002684204959461 - ] - }, - "forward_reverse": { - "translation_m": 0.011212969141455763, - "rotation_deg": 0.08373658947114908 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 2.749658739313112e-15, - "rotation_deg": 2.2280720281219955e-14 - }, - { - "translation_m": 3.9394491319598717, - "rotation_deg": 14.745371348057061 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 7, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 3621, - "frame_counter_j": 6006, - "rtk_translation_m": 5.314106070657687, - "rtk_rotation_deg": 123.28910472998356, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.551778422493324, - -0.8326271560469253, - -0.0476717052766947, - 2.399423296507796 - ], - [ - 0.8333280707624733, - -0.5527167714067429, - 0.008276296575140195, - 3.9557143537357122 - ], - [ - -0.03324002030794837, - -0.03515948831986747, - 0.9988287698254449, - 0.11782839969184788 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8120, - "backend_objective": 911.3269054429245, - "backend_elapsed_sec": 0.2587496999767609, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 4340, - "objective": 1168.9548284196028 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6693, - "objective": 667.6622157295589 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8120, - "objective": 911.3269054429245 - } - ], - "heldout_symmetric": { - "evaluated": 8094, - "inliers": 5641, - "inlier_ratio": 0.696936001976773, - "inlier_rmse_m": 0.11799538994568655, - "median_m": 0.13117582233595904, - "p90_m": 0.8734065520860324, - "p95_m": 1.3047221742601938 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44815.362013424856, - 81485.57205402893, - 149068.71423976633, - 283990.86435743235, - 594300.7090449224, - 757122.4098688973 - ], - "effective_rank": 6, - "scaled_condition_number": 16.89426071448657, - "weakest_scaled_direction": [ - 0.06594166242816017, - -0.06458643039461481, - 0.010881795535945824, - -0.168340367826165, - 0.9805634427395648, - -0.03897091240772168 - ] - }, - "forward_reverse": { - "translation_m": 0.00409529177569414, - "rotation_deg": 0.0519770010059835 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 2.0708381084068963e-05, - "rotation_deg": 2.448970877648878e-05 - }, - { - "translation_m": 4.150540892490724, - "rotation_deg": 14.444443118813961 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 8, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 3621, - "frame_counter_j": 6878, - "rtk_translation_m": 5.8981084980454765, - "rtk_rotation_deg": 146.08873096228052, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8230585501363342, - 0.5664886127873069, - -0.04080777658471567, - 1.1763627337508966 - ], - [ - -0.5656853135574051, - -0.824067644281984, - -0.030209992932839415, - 3.9319938046451908 - ], - [ - -0.05074198530739072, - -0.0017802330900263054, - 0.998710209068281, - 0.05831095285049873 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8126, - "backend_objective": 1395.105996665611, - "backend_elapsed_sec": 0.29162850001011975, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4239, - "objective": 1045.507242743976 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6636, - "objective": 683.7631380532132 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8126, - "objective": 1395.105996665611 - } - ], - "heldout_symmetric": { - "evaluated": 8158, - "inliers": 5816, - "inlier_ratio": 0.7129198332924737, - "inlier_rmse_m": 0.11349036082807595, - "median_m": 0.12174384310683242, - "p90_m": 0.7662109101628424, - "p95_m": 1.27093399641272 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43854.08277708816, - 147424.1769120334, - 165074.9461661054, - 461930.31112894457, - 587030.0288614861, - 816428.1755470857 - ], - "effective_rank": 6, - "scaled_condition_number": 18.616925126379197, - "weakest_scaled_direction": [ - 0.008525273930728508, - 0.07037188777655633, - 0.0029364544939218615, - -0.9842591433276218, - -0.16146055329769937, - 0.011442152548863415 - ] - }, - "forward_reverse": { - "translation_m": 0.01249802665331653, - "rotation_deg": 0.04549823831834878 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0565363201361521e-15, - "rotation_deg": 3.688480629111411e-15 - }, - { - "translation_m": 1.1567783389051904e-15, - "rotation_deg": 4.004855127086144e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 9, - "lidar_time_i": 1784784149.2434597, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 3621, - "frame_counter_j": 7623, - "rtk_translation_m": 3.1650365894055956, - "rtk_rotation_deg": 158.11607430100375, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9245775344317981, - 0.37492570835562733, - -0.06772810375353527, - -5.619191303355375 - ], - [ - -0.3762742140238945, - -0.9264746043425068, - 0.007907172003650162, - 0.10900839528480788 - ], - [ - -0.059783766063366495, - 0.03279513260265325, - 0.9976724816255362, - -0.1753923001723502 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 6479, - "backend_objective": 579.3974892880387, - "backend_elapsed_sec": 0.3270135000057053, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3621, - "objective": 894.7035123523374 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5371, - "objective": 405.9383838926391 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 6479, - "objective": 579.3974892880387 - } - ], - "heldout_symmetric": { - "evaluated": 8207, - "inliers": 5004, - "inlier_ratio": 0.6097234068478128, - "inlier_rmse_m": 0.11677937926620108, - "median_m": 0.16010401355984838, - "p90_m": 1.4432517724797858, - "p95_m": 2.024006149456596 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 28502.594796980742, - 34954.04382772704, - 72559.5090223596, - 93660.34393608902, - 384177.170504467, - 739549.7164863998 - ], - "effective_rank": 6, - "scaled_condition_number": 25.94675052408701, - "weakest_scaled_direction": [ - 0.7532750218769544, - 0.019100684498135678, - 0.021577140405260743, - 0.288207459563672, - 0.16037921728186152, - -0.568296840740664 - ] - }, - "forward_reverse": { - "translation_m": 0.00616984405743089, - "rotation_deg": 0.11548555225177864 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 3.684743678573239, - "rotation_deg": 8.917021605976972 - }, - { - "translation_m": 7.327682229021407e-16, - "rotation_deg": 2.7284661037734292e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 6, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784301.6372502, - "frame_counter_i": 4371, - "frame_counter_j": 5145, - "rtk_translation_m": 1.9357867378988893, - "rtk_rotation_deg": 56.54578494904757, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5633453878228181, - -0.8258046721041434, - -0.02624152338809676, - 0.123729406077843 - ], - [ - 0.8262070981271508, - 0.5632389159328265, - 0.011989769936393205, - 2.877432713421258 - ], - [ - 0.004879039154610243, - -0.028435314483638965, - 0.9995837272920881, - 0.09881861794523908 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8550, - "backend_objective": 1190.9493477572096, - "backend_elapsed_sec": 0.2862141999939922, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4238, - "objective": 1014.755055819071 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6853, - "objective": 872.9701826168684 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8550, - "objective": 1190.9493477572096 - } - ], - "heldout_symmetric": { - "evaluated": 8079, - "inliers": 6144, - "inlier_ratio": 0.7604901596732269, - "inlier_rmse_m": 0.11101741624951145, - "median_m": 0.1098746279102792, - "p90_m": 0.6999629104990043, - "p95_m": 1.2865591824571803 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 48399.23367949531, - 63739.6105463391, - 183676.69309251418, - 213768.82216003287, - 473447.78057423956, - 812688.1981731247 - ], - "effective_rank": 6, - "scaled_condition_number": 16.791344333152654, - "weakest_scaled_direction": [ - -0.08980395369145808, - -0.04103955313972449, - -0.03088420242237186, - 0.5755629976571488, - -0.8111072995478653, - 0.01137345014904398 - ] - }, - "forward_reverse": { - "translation_m": 0.01028641250952863, - "rotation_deg": 0.031127073736479716 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.828670879282072e-16, - "rotation_deg": 1.762878204908289e-14 - }, - { - "translation_m": 1.1322097734007351e-15, - "rotation_deg": 3.785341145175467e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 7, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 4371, - "frame_counter_j": 6006, - "rtk_translation_m": 0.19501559913675365, - "rtk_rotation_deg": 81.85735125585654, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1555886146242255, - -0.9875503789153085, - -0.023161003940796943, - -1.2124291651011598 - ], - [ - 0.9878123237292821, - 0.1556477784433822, - -0.0007629902985765479, - 1.0841654619680714 - ], - [ - 0.004358450168371444, - -0.02276001251913443, - 0.9997314568134081, - 0.025125772210571946 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 9069, - "backend_objective": 1560.896240171915, - "backend_elapsed_sec": 0.28599299999768846, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4399, - "objective": 982.6352876946811 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7186, - "objective": 1034.0781039114954 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 9069, - "objective": 1560.896240171915 - } - ], - "heldout_symmetric": { - "evaluated": 8027, - "inliers": 6496, - "inlier_ratio": 0.8092687180764918, - "inlier_rmse_m": 0.10777871969807898, - "median_m": 0.09896862680977196, - "p90_m": 0.5028552845289067, - "p95_m": 0.9027651744908558 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 58304.9798973356, - 122521.56729192781, - 313784.5960502238, - 428531.57400996145, - 649057.5496280706, - 886433.1390384957 - ], - "effective_rank": 6, - "scaled_condition_number": 15.20338641054919, - "weakest_scaled_direction": [ - -0.07106918665679612, - -0.009478504710697777, - -0.017555608793906902, - 0.18019014046939646, - -0.9806403872882102, - -0.020665753146522137 - ] - }, - "forward_reverse": { - "translation_m": 0.010579714886860828, - "rotation_deg": 0.03333492483252218 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 0.00020624130376430415, - "rotation_deg": 0.0012803364903162873 - }, - { - "translation_m": 0.00020624130376367875, - "rotation_deg": 0.0012803364903171586 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 8, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 4371, - "frame_counter_j": 6878, - "rtk_translation_m": 1.8038807059856978, - "rtk_rotation_deg": 172.47951556359365, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.989043789356313, - -0.13824265003616112, - -0.051781777168087864, - -2.127120411843897 - ], - [ - 0.1399077673482785, - -0.9897091205461781, - -0.030027876104239497, - 1.8903823432013909 - ], - [ - -0.047097763973738764, - -0.036943557201372136, - 0.9982068794643641, - -0.05425103705640133 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8167, - "backend_objective": 911.0549254504226, - "backend_elapsed_sec": 0.39979839997249655, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 4185, - "objective": 990.3528848304294 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6647, - "objective": 739.1754678887037 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8167, - "objective": 911.0549254504226 - } - ], - "heldout_symmetric": { - "evaluated": 8091, - "inliers": 5903, - "inlier_ratio": 0.7295760721789643, - "inlier_rmse_m": 0.11311887218463837, - "median_m": 0.1191035473389751, - "p90_m": 0.8208300037591001, - "p95_m": 1.3956153630557229 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 43843.61449220036, - 72080.001103961, - 156100.69687134246, - 244088.09168319812, - 548300.927810985, - 747685.4323274246 - ], - "effective_rank": 6, - "scaled_condition_number": 17.053462425193878, - "weakest_scaled_direction": [ - 0.08955216039964135, - -0.07466934828288518, - 0.012579064266736778, - 0.9768816758948728, - 0.17817914185739156, - 0.014179239920658575 - ] - }, - "forward_reverse": { - "translation_m": 0.009759205787181369, - "rotation_deg": 0.05935114015788255 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.281202090555001e-16, - "rotation_deg": 4.827670870689668e-15 - }, - { - "translation_m": 7.102651377905854e-07, - "rotation_deg": 2.5601660870277687e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 9, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 4371, - "frame_counter_j": 7623, - "rtk_translation_m": 7.881613621164215, - "rtk_rotation_deg": 160.45217222486949, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.935144645130155, - -0.3486484848767959, - -0.06283889462355961, - -9.741602292759962 - ], - [ - 0.34846385695356036, - -0.9372141946978932, - 0.014230026487268855, - 3.66811733618357 - ], - [ - -0.06385478119486813, - -0.008589950517594196, - 0.9979222312728888, - -0.2770624000724965 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5548, - "backend_objective": 430.6958553724255, - "backend_elapsed_sec": 0.37327330000698566, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3565, - "objective": 1021.7625342165487 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5015, - "objective": 560.8323333383298 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5548, - "objective": 430.6958553724255 - } - ], - "heldout_symmetric": { - "evaluated": 8140, - "inliers": 4192, - "inlier_ratio": 0.514987714987715, - "inlier_rmse_m": 0.13057312144553648, - "median_m": 0.2372434596641945, - "p90_m": 1.6330972938281554, - "p95_m": 2.609032762991326 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16689.387754071493, - 21711.291631547363, - 43013.95749940708, - 76472.2653266211, - 250776.93482799002, - 613561.2792232784 - ], - "effective_rank": 6, - "scaled_condition_number": 36.76355827214787, - "weakest_scaled_direction": [ - 0.6453018415031739, - 0.22710962037942833, - 0.022800493863631806, - 0.4858979583141081, - 0.23517105842851208, - -0.4899843247973277 - ] - }, - "forward_reverse": { - "translation_m": 0.013423709236357283, - "rotation_deg": 0.8456480282562385 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.482940736268976e-05, - "rotation_deg": 0.0028185092825386508 - }, - { - "translation_m": 5.113269112482064e-06, - "rotation_deg": 1.1019559180956556e-05 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 5, - "j": 10, - "lidar_time_i": 1784784224.2408776, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 4371, - "frame_counter_j": 8276, - "rtk_translation_m": 7.671857805815354, - "rtk_rotation_deg": 143.54232919109316, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8102224662916406, - 0.584630388816484, - -0.041795497228493836, - -9.91223605454469 - ], - [ - -0.5828986823978723, - -0.8111835906903282, - -0.04701391553115116, - 0.439643191413919 - ], - [ - -0.0613895852332592, - -0.013729190327023234, - 0.998019452795311, - -0.2327682687560738 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6242, - "backend_objective": 459.54726521698797, - "backend_elapsed_sec": 0.7127776000124868, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 20, - "num_inliers": 3943, - "objective": 1737.3754506655084 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 5509, - "objective": 649.7054411431354 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6242, - "objective": 459.54726521698797 - } - ], - "heldout_symmetric": { - "evaluated": 8228, - "inliers": 4478, - "inlier_ratio": 0.5442391832766165, - "inlier_rmse_m": 0.13173165083201857, - "median_m": 0.21318490235964233, - "p90_m": 1.7031669990975942, - "p95_m": 2.4625418073761773 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 23843.846922270168, - 31566.52141650056, - 46612.5091334634, - 77075.53779336283, - 268920.7635411925, - 627980.7105134609 - ], - "effective_rank": 6, - "scaled_condition_number": 26.337222871823027, - "weakest_scaled_direction": [ - -0.039136354401498145, - -0.04141233640357178, - -0.0011318194785625462, - 0.8232989865454154, - -0.5605664462660774, - -0.06852825122778679 - ] - }, - "forward_reverse": { - "translation_m": 0.00523999417676037, - "rotation_deg": 0.17134499262937464 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.493957768041548e-07, - "rotation_deg": 1.6379535954423843e-06 - }, - { - "translation_m": 1.0057327710640516e-15, - "rotation_deg": 2.981354146035955e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 7, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784387.733771, - "frame_counter_i": 5145, - "frame_counter_j": 6006, - "rtk_translation_m": 2.130456053070114, - "rtk_rotation_deg": 25.311566306808988, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.903816336210661, - -0.4278967661815101, - -0.0045152951336126295, - -2.238117232394065 - ], - [ - 0.42787476180112083, - 0.9038236542245877, - -0.005098066079151287, - 0.08983993299489049 - ], - [ - 0.006262476536612753, - 0.0026757345756621017, - 0.9999768106471816, - -0.04295472992242238 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 9528, - "backend_objective": 967.9119598478012, - "backend_elapsed_sec": 0.22638690000167117, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4417, - "objective": 907.9839605449163 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7396, - "objective": 598.4407511552671 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 9528, - "objective": 967.9119598478012 - } - ], - "heldout_symmetric": { - "evaluated": 7928, - "inliers": 6770, - "inlier_ratio": 0.8539354187689203, - "inlier_rmse_m": 0.10462253085153163, - "median_m": 0.09089497611222586, - "p90_m": 0.34589342958747005, - "p95_m": 0.6093985534408818 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 67533.4761572415, - 75784.2925666808, - 254733.81929713167, - 520339.422211383, - 678526.7038856247, - 844365.0261521871 - ], - "effective_rank": 6, - "scaled_condition_number": 12.502910766598342, - "weakest_scaled_direction": [ - -0.04916099685404092, - -0.020925498702230427, - -0.0009383292158298141, - 0.189497561190563, - -0.9804246414553831, - 0.0016236257497808974 - ] - }, - "forward_reverse": { - "translation_m": 0.002843314342407394, - "rotation_deg": 0.028424505305675103 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3520108268424918e-05, - "rotation_deg": 0.00024038284434075026 - }, - { - "translation_m": 7.588439123779458e-14, - "rotation_deg": 1.788188916214634e-12 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 5145, - "frame_counter_j": 6878, - "rtk_translation_m": 0.24494500622098103, - "rtk_rotation_deg": 115.93373061454483, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.4417415919170311, - -0.8960836883888302, - -0.043570510372002415, - -2.0801537079611045 - ], - [ - 0.8970195349329632, - -0.44196345584787117, - -0.004925204935534324, - 1.296659718225676 - ], - [ - -0.014843177532361237, - -0.04125926681942602, - 0.9990382139749538, - -0.060069474061796 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8509, - "backend_objective": 798.712662343223, - "backend_elapsed_sec": 0.2860050000017509, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4350, - "objective": 1063.7956670653055 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6913, - "objective": 677.9644992233723 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8509, - "objective": 798.712662343223 - } - ], - "heldout_symmetric": { - "evaluated": 7992, - "inliers": 6200, - "inlier_ratio": 0.7757757757757757, - "inlier_rmse_m": 0.1131640002846509, - "median_m": 0.10815997691749255, - "p90_m": 0.5778816662633676, - "p95_m": 0.9477012148061267 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53837.05517196205, - 63412.648740112454, - 156742.37273516264, - 321227.1632565483, - 704113.8368888075, - 835645.168237381 - ], - "effective_rank": 6, - "scaled_condition_number": 15.521747346102597, - "weakest_scaled_direction": [ - 0.1336094425880643, - -0.051201145853172314, - 0.006609490973777755, - 0.9734041540341579, - 0.17720534798243429, - 0.02378847828605677 - ] - }, - "forward_reverse": { - "translation_m": 0.007224674181694773, - "rotation_deg": 0.10395594559619498 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2713088951712972e-15, - "rotation_deg": 1.2535080635125873e-15 - }, - { - "translation_m": 2.7184882531662156e-15, - "rotation_deg": 4.268472857957785e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 5145, - "frame_counter_j": 7623, - "rtk_translation_m": 8.025985916230132, - "rtk_rotation_deg": 103.90638727582186, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.23933357401741576, - -0.9709359548600442, - 0.0016768744928121674, - -4.888304363513462 - ], - [ - 0.9707892049528275, - -0.23926651269745547, - 0.017884503030732156, - 8.574670623379882 - ], - [ - -0.01696348711521479, - 0.005908253685553226, - 0.9998386533052618, - 0.09313031290403795 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6221, - "backend_objective": 632.1522892990403, - "backend_elapsed_sec": 0.27332659999956377, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3733, - "objective": 1053.3640164002381 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5493, - "objective": 554.7744093376959 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6221, - "objective": 632.1522892990403 - } - ], - "heldout_symmetric": { - "evaluated": 8041, - "inliers": 4832, - "inlier_ratio": 0.6009202835468226, - "inlier_rmse_m": 0.1259448851291812, - "median_m": 0.17414727637283134, - "p90_m": 1.1907502106432875, - "p95_m": 1.8639725078609017 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22861.98250361814, - 26337.171411235602, - 53943.12212662387, - 163054.33254127414, - 247957.03602520522, - 658315.1294629404 - ], - "effective_rank": 6, - "scaled_condition_number": 28.795189977892573, - "weakest_scaled_direction": [ - 0.37740074542762864, - 0.1117288849914091, - 0.02018633881794456, - 0.8201500150733184, - 0.34898400702905, - -0.2241471859014914 - ] - }, - "forward_reverse": { - "translation_m": 0.007975110549369148, - "rotation_deg": 0.07338758946554978 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.39188966358397e-16, - "rotation_deg": 1.6768013629861905e-14 - }, - { - "translation_m": 8.899114524108741e-16, - "rotation_deg": 1.3688984843834901e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 10, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 5145, - "frame_counter_j": 8276, - "rtk_translation_m": 8.303463402700086, - "rtk_rotation_deg": 159.91188585985975, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9386504575160534, - -0.3412675181111925, - -0.04971719709650229, - -7.676787596102102 - ], - [ - 0.3427907075780171, - -0.9390518733119324, - -0.02600211582761954, - 6.9295262521925745 - ], - [ - -0.03781334953515751, - -0.04144949108948617, - 0.9984248045222804, - -0.014729886776682672 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6042, - "backend_objective": 421.7166624929832, - "backend_elapsed_sec": 0.3282193000195548, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 3999, - "objective": 1316.0904703785436 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5531, - "objective": 703.9032624697284 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6042, - "objective": 421.7166624929832 - } - ], - "heldout_symmetric": { - "evaluated": 8129, - "inliers": 4360, - "inlier_ratio": 0.5363513347275187, - "inlier_rmse_m": 0.13083118553166714, - "median_m": 0.21935723463379142, - "p90_m": 1.6653789510194081, - "p95_m": 2.322035390231559 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20109.104728678132, - 21323.193111517587, - 42816.04753689338, - 97743.45923404122, - 238392.02166191582, - 626753.7645055518 - ], - "effective_rank": 6, - "scaled_condition_number": 31.167661263990606, - "weakest_scaled_direction": [ - -0.6553017924210387, - 0.3914158782408808, - -0.0008046946753143494, - -0.5605846166082455, - 0.31733093897426073, - 0.049178108636606585 - ] - }, - "forward_reverse": { - "translation_m": 1.7146158775247784, - "rotation_deg": 14.688249303878628 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.7324799859770865e-15, - "rotation_deg": 4.077222334994345e-14 - }, - { - "translation_m": 4.432905188312947e-15, - "rotation_deg": 4.5554237104872835e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 6, - "j": 11, - "lidar_time_i": 1784784301.6372502, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 5145, - "frame_counter_j": 8958, - "rtk_translation_m": 11.328882063792355, - "rtk_rotation_deg": 138.54043874549896, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7506504661534054, - -0.6587274700724787, - -0.05100978176376703, - -10.25490447137044 - ], - [ - 0.6603256958564974, - -0.7505832779969291, - -0.02438684446617117, - 8.88686075020083 - ], - [ - -0.02222280484790427, - -0.05198906580518948, - 0.9984003625707457, - -0.027423987565750433 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 4745, - "backend_objective": 303.62057820395694, - "backend_elapsed_sec": 0.39190260000759736, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3612, - "objective": 1298.241906433932 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4495, - "objective": 566.4614808703178 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 4745, - "objective": 303.62057820395694 - } - ], - "heldout_symmetric": { - "evaluated": 7841, - "inliers": 3633, - "inlier_ratio": 0.4633337584491774, - "inlier_rmse_m": 0.13769942152040132, - "median_m": 0.28909135050969004, - "p90_m": 1.99746033667199, - "p95_m": 2.682341573042235 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 9886.936957579832, - 16725.091120622805, - 27443.236334426467, - 57611.55488206106, - 176884.1961096952, - 577169.8629601572 - ], - "effective_rank": 6, - "scaled_condition_number": 58.377014583638996, - "weakest_scaled_direction": [ - 0.9175892817389134, - -0.09240989109957376, - -0.000575180334206903, - 0.18140715432267251, - 0.02132241852270542, - 0.3407738107033831 - ] - }, - "forward_reverse": { - "translation_m": 0.023339879627157865, - "rotation_deg": 0.18888808553225306 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.112343365827712e-15, - "rotation_deg": 1.4889738300726686e-14 - }, - { - "translation_m": 2.1795197195325206e-15, - "rotation_deg": 1.1923503179419012e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 8, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784474.9314597, - "frame_counter_i": 6006, - "frame_counter_j": 6878, - "rtk_translation_m": 1.9962664218365056, - "rtk_rotation_deg": 90.62216430773583, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.015575129246330722, - -0.998947724407544, - -0.04313767784605076, - 0.6650746067001984 - ], - [ - 0.9998751093195618, - -0.015676198192909677, - 0.002005635413113796, - 1.0297315594440202 - ], - [ - -0.002679759719417803, - -0.04310105232133182, - 0.9990671239594668, - 0.021464738545207192 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 9269, - "backend_objective": 1211.8424907334938, - "backend_elapsed_sec": 0.5779362000175752, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4449, - "objective": 725.2848772368529 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7399, - "objective": 918.7144988456685 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 9269, - "objective": 1211.8424907334938 - } - ], - "heldout_symmetric": { - "evaluated": 7940, - "inliers": 6622, - "inlier_ratio": 0.8340050377833753, - "inlier_rmse_m": 0.11132245152738919, - "median_m": 0.10235115239145279, - "p90_m": 0.38695471193159847, - "p95_m": 0.7071362834784134 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 56892.708551191885, - 159705.36847593202, - 216350.72338471992, - 396516.6641602697, - 859499.768491504, - 919975.0539280197 - ], - "effective_rank": 6, - "scaled_condition_number": 16.170350777028464, - "weakest_scaled_direction": [ - -0.031887616577349676, - 0.0978563998797459, - -0.019655922821621086, - -0.9798608488407152, - -0.169964623682212, - -0.0023860459631844843 - ] - }, - "forward_reverse": { - "translation_m": 0.004806949653405585, - "rotation_deg": 0.02034039865601464 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2530543612044369e-15, - "rotation_deg": 3.634283176409649e-15 - }, - { - "translation_m": 8.007811261798586e-16, - "rotation_deg": 7.058683289809877e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 9, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 6006, - "frame_counter_j": 7623, - "rtk_translation_m": 7.8811064994361235, - "rtk_rotation_deg": 78.59482096901284, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.1987460112662474, - -0.9800239171286769, - 0.0072900522303022165, - 1.232593111217831 - ], - [ - 0.9798240623423039, - 0.1988545643140699, - 0.020041684222784073, - 8.81379910842588 - ], - [ - -0.021090990037952423, - 0.003159763792646276, - 0.9997725671531473, - 0.05893003624333094 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6563, - "backend_objective": 579.0289537400707, - "backend_elapsed_sec": 0.33615809999173507, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3732, - "objective": 1035.3979929388902 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5690, - "objective": 641.7015263772731 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6563, - "objective": 579.0289537400707 - } - ], - "heldout_symmetric": { - "evaluated": 7989, - "inliers": 4922, - "inlier_ratio": 0.6160971335586432, - "inlier_rmse_m": 0.12637042711002067, - "median_m": 0.17161346512353012, - "p90_m": 1.2286319173668765, - "p95_m": 1.912245360708687 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 26448.731670219793, - 28519.307971584632, - 56345.57086135047, - 162736.02196619354, - 312472.10544495506, - 639495.0168850824 - ], - "effective_rank": 6, - "scaled_condition_number": 24.17866477904224, - "weakest_scaled_direction": [ - -0.5499601899624774, - -0.06252867361524048, - -0.018988035468898386, - -0.7156176371642422, - -0.31921783589049624, - 0.2815400141547218 - ] - }, - "forward_reverse": { - "translation_m": 0.012112046262530643, - "rotation_deg": 0.5927664140170301 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.125882886419572e-15, - "rotation_deg": 2.2093607401731488e-13 - }, - { - "translation_m": 5.688265343916739e-14, - "rotation_deg": 1.4124558378794116e-12 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 7, - "j": 10, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 6006, - "frame_counter_j": 8276, - "rtk_translation_m": 7.620696678413973, - "rtk_rotation_deg": 134.60031955305035, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7021951307608287, - -0.7103295416361552, - -0.04851742588752914, - -1.9924158672542818 - ], - [ - 0.7110990662865663, - -0.7030891198748863, - 0.001951266238155456, - 8.492405615922873 - ], - [ - -0.03549811631841692, - -0.03313052659599889, - 0.9988204302802964, - 0.05513288958260977 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6733, - "backend_objective": 507.4437443751415, - "backend_elapsed_sec": 0.3288567999843508, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4218, - "objective": 1268.9921617749187 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5953, - "objective": 564.4925870205415 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6733, - "objective": 507.4437443751415 - } - ], - "heldout_symmetric": { - "evaluated": 8077, - "inliers": 4621, - "inlier_ratio": 0.5721183607775164, - "inlier_rmse_m": 0.13040415535689726, - "median_m": 0.19470962492307675, - "p90_m": 1.3294493585805893, - "p95_m": 1.9149484669944727 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31214.11671303788, - 36779.35561015317, - 64147.10865950941, - 95570.78320399583, - 369800.4899921501, - 642132.8386662777 - ], - "effective_rank": 6, - "scaled_condition_number": 20.571872802604858, - "weakest_scaled_direction": [ - -0.01506726367338361, - 0.151262929506742, - 0.002769142492144822, - -0.8157435900050348, - 0.5496934778839169, - 0.09635513120677543 - ] - }, - "forward_reverse": { - "translation_m": 0.010507785715791607, - "rotation_deg": 0.10324111221368969 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.440892098500626e-16, - "rotation_deg": 7.396663432446125e-15 - }, - { - "translation_m": 2.8000135031123616e-15, - "rotation_deg": 1.529851387921262e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 11, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 6006, - "frame_counter_j": 8958, - "rtk_translation_m": 10.356268683459426, - "rtk_rotation_deg": 113.22887243868989, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3958821146862112, - -0.9172372745097772, - -0.044194270233249754, - -3.4838146346579677 - ], - [ - 0.9181699573312505, - -0.3961808801824617, - -0.0021539805430749333, - 11.372971737118831 - ], - [ - -0.01553321363735332, - -0.04143057358673409, - 0.9990206338441513, - 0.05245460282842453 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5454, - "backend_objective": 431.2874040786367, - "backend_elapsed_sec": 0.4485889000061434, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3851, - "objective": 1191.5832359732697 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5217, - "objective": 610.6771379474781 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5454, - "objective": 431.2874040786367 - } - ], - "heldout_symmetric": { - "evaluated": 7789, - "inliers": 4034, - "inlier_ratio": 0.5179098728976762, - "inlier_rmse_m": 0.13593896500168, - "median_m": 0.23308466036992806, - "p90_m": 1.5903235951488612, - "p95_m": 2.35130130918032 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 17600.616225415997, - 27686.44606155642, - 46608.027700594444, - 73075.6451347259, - 299010.4103784413, - 636838.9524350392 - ], - "effective_rank": 6, - "scaled_condition_number": 36.18276452817704, - "weakest_scaled_direction": [ - 0.12021964803006051, - -0.06152608364791256, - -0.009060896325285917, - 0.9676254882221084, - -0.2115491017015165, - -0.025051337857858708 - ] - }, - "forward_reverse": { - "translation_m": 0.01570096854689765, - "rotation_deg": 0.062213006599939585 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.440892098500626e-16, - "rotation_deg": 2.3191600509986052e-15 - }, - { - "translation_m": 3.916684464318413e-15, - "rotation_deg": 4.9138628136762796e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 12, - "lidar_time_i": 1784784387.733771, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 6006, - "frame_counter_j": 9717, - "rtk_translation_m": 13.76202076313695, - "rtk_rotation_deg": 94.9510481861355, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.09105685096653844, - -0.9948838238547816, - -0.04375873540386313, - -2.882347543007339 - ], - [ - 0.995665170951414, - -0.09178905356754663, - 0.01502121830829222, - 14.942363422798389 - ], - [ - -0.01896094001754452, - -0.04220126392967105, - 0.9989291947262279, - 0.047133237746127675 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 4892, - "backend_objective": 308.71653537220755, - "backend_elapsed_sec": 0.414707299991278, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3543, - "objective": 1486.4483684820311 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 4885, - "objective": 824.5120965570165 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 4892, - "objective": 308.71653537220755 - } - ], - "heldout_symmetric": { - "evaluated": 8011, - "inliers": 3358, - "inlier_ratio": 0.419173636250156, - "inlier_rmse_m": 0.14753718360891266, - "median_m": 0.32493234801462306, - "p90_m": 1.8294809048516345, - "p95_m": 2.8849842982348815 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6448.9037381029, - 12970.81955992246, - 19982.864476873714, - 37484.66857646037, - 241967.7689235441, - 575820.0746342305 - ], - "effective_rank": 6, - "scaled_condition_number": 89.28960611274712, - "weakest_scaled_direction": [ - 0.9264290241280293, - 0.15832099245514938, - 0.006538034766120178, - -0.07409119321316872, - 0.05915070649239118, - 0.3280741832456509 - ] - }, - "forward_reverse": { - "translation_m": 0.018245717875293024, - "rotation_deg": 0.41212759156893974 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.985994439185401e-15, - "rotation_deg": 2.7685093616410986e-14 - }, - { - "translation_m": 1.2412670766236366e-15, - "rotation_deg": 2.9368517486974605e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 9, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784549.4274275, - "frame_counter_i": 6878, - "frame_counter_j": 7623, - "rtk_translation_m": 7.803713858547152, - "rtk_rotation_deg": 12.027343338722998, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9767614712966242, - 0.21427395168652957, - 0.004868451405968611, - 7.766978515767815 - ], - [ - -0.2139069629591747, - 0.9760106497080835, - -0.0405835293436424, - -0.7070571255107969 - ], - [ - -0.013447653625660153, - 0.03859903217754081, - 0.999164288456569, - 0.12803808425669047 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 6804, - "backend_objective": 531.6935692491993, - "backend_elapsed_sec": 0.2675932999991346, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3880, - "objective": 1018.048380404935 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5890, - "objective": 628.0580165416324 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 6804, - "objective": 531.6935692491993 - } - ], - "heldout_symmetric": { - "evaluated": 8053, - "inliers": 5160, - "inlier_ratio": 0.6407549981373402, - "inlier_rmse_m": 0.12189583104066963, - "median_m": 0.15419497180015548, - "p90_m": 1.1291169201957723, - "p95_m": 1.7319093677442594 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24102.672656024908, - 28132.24412747677, - 60991.30839574281, - 126216.67179941971, - 312060.103447803, - 676492.9307550354 - ], - "effective_rank": 6, - "scaled_condition_number": 28.06713348388497, - "weakest_scaled_direction": [ - 0.6462448740678424, - 0.1405828012021304, - 0.01738749021676203, - 0.6466690564364066, - 0.29873514167101284, - -0.23426088130460485 - ] - }, - "forward_reverse": { - "translation_m": 0.025170709673794655, - "rotation_deg": 0.14112050756711447 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.938893903907228e-16, - "rotation_deg": 9.647521844476607e-15 - }, - { - "translation_m": 1.0068810866857322e-15, - "rotation_deg": 1.4503947531494247e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 10, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 6878, - "frame_counter_j": 8276, - "rtk_translation_m": 8.062504137991457, - "rtk_rotation_deg": 43.97815524531457, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7227614730011143, - -0.6909633900050299, - -0.013617885959897949, - 7.504727299229808 - ], - [ - 0.6910846376839269, - 0.7224870681747577, - 0.020358287686297997, - 2.5189109601011483 - ], - [ - -0.004228084972517256, - -0.024125297780546298, - 0.9997000016527283, - 0.24205873956103108 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7010, - "backend_objective": 812.9622128843123, - "backend_elapsed_sec": 0.2784631999966223, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4331, - "objective": 1255.0369765197802 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6260, - "objective": 727.8061185566299 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7010, - "objective": 812.9622128843123 - } - ], - "heldout_symmetric": { - "evaluated": 8141, - "inliers": 4946, - "inlier_ratio": 0.6075420709986488, - "inlier_rmse_m": 0.12933255373443525, - "median_m": 0.1773875611131982, - "p90_m": 1.0586313554558715, - "p95_m": 1.5992170956790337 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 30435.712422955603, - 52010.38323259794, - 133772.92953285715, - 158835.34324193356, - 343687.89863201004, - 621790.4316893131 - ], - "effective_rank": 6, - "scaled_condition_number": 20.429632894689156, - "weakest_scaled_direction": [ - -0.03512224446332845, - 0.09088531156333027, - 0.012075344276156075, - -0.8199771153633209, - 0.5619352444233221, - 0.04718882814666677 - ] - }, - "forward_reverse": { - "translation_m": 0.01256038832173067, - "rotation_deg": 0.12386976869589704 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6023110072162766e-08, - "rotation_deg": 2.0998959129808942e-08 - }, - { - "translation_m": 2.6023109930632802e-08, - "rotation_deg": 2.0998958826595784e-08 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 11, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 6878, - "frame_counter_j": 8958, - "rtk_translation_m": 11.084531710563947, - "rtk_rotation_deg": 22.606708130954026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9243899349067348, - -0.38120141047961975, - -0.013738009006799418, - 10.405956760445594 - ], - [ - 0.3813336258467257, - 0.9243963821216479, - 0.00871748352433042, - 3.96946634435529 - ], - [ - 0.009376248808132398, - -0.013297118814084123, - 0.9998676275335311, - 0.2888452351987371 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 5606, - "backend_objective": 378.5080329085616, - "backend_elapsed_sec": 0.2886214999889489, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3910, - "objective": 1056.2927355913773 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5256, - "objective": 548.4385197355723 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 5606, - "objective": 378.5080329085616 - } - ], - "heldout_symmetric": { - "evaluated": 7853, - "inliers": 4278, - "inlier_ratio": 0.5447599643448364, - "inlier_rmse_m": 0.13547919137380177, - "median_m": 0.21351278265947216, - "p90_m": 1.3398476713241319, - "p95_m": 2.091862477817637 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22774.38438022873, - 28226.403973158238, - 56159.97681521618, - 69727.78054387387, - 249511.41633860112, - 631497.3153184594 - ], - "effective_rank": 6, - "scaled_condition_number": 27.72840331379869, - "weakest_scaled_direction": [ - 0.34269641788326166, - -0.2690626197573097, - -0.025245826519742637, - 0.8753625298150922, - -0.17049792995682203, - -0.11915543352616999 - ] - }, - "forward_reverse": { - "translation_m": 0.006462771421800638, - "rotation_deg": 0.08629803406158434 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9301603260928013e-15, - "rotation_deg": 2.6444228144193955e-14 - }, - { - "translation_m": 4.723897861430799e-14, - "rotation_deg": 5.544805625423182e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 12, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 6878, - "frame_counter_j": 9717, - "rtk_translation_m": 14.350449135419003, - "rtk_rotation_deg": 4.328883878399632, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9971754663480695, - -0.07507512775379334, - -0.002194198318704511, - 13.966714483921436 - ], - [ - 0.0750908502042479, - 0.9971423273214032, - 0.008279086885561782, - 3.3035957215894984 - ], - [ - 0.0015663745124994213, - -0.008420466543314511, - 0.9999633204343442, - 0.35012164117541633 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 5236, - "backend_objective": 329.7824719483567, - "backend_elapsed_sec": 0.29968260001624003, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3713, - "objective": 1199.9425263214039 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5038, - "objective": 579.3374261002559 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 5236, - "objective": 329.7824719483567 - } - ], - "heldout_symmetric": { - "evaluated": 8075, - "inliers": 3754, - "inlier_ratio": 0.46489164086687307, - "inlier_rmse_m": 0.14530908872417966, - "median_m": 0.27951538979919144, - "p90_m": 1.5491108102474644, - "p95_m": 2.3089813172626723 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 13901.219791369556, - 18966.638816699935, - 37841.70941568832, - 55816.59050224912, - 208073.3462936252, - 527675.9118769562 - ], - "effective_rank": 6, - "scaled_condition_number": 37.958964738084276, - "weakest_scaled_direction": [ - 0.8638632830539, - -0.06878739138695336, - 0.0030384305954635244, - 0.2851460604957918, - 0.10986761218753847, - -0.3944871644210632 - ] - }, - "forward_reverse": { - "translation_m": 0.00955628888567663, - "rotation_deg": 0.1112688142308669 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.9506627632986034e-15, - "rotation_deg": 1.0915323608264886e-14 - }, - { - "translation_m": 4.1143762843750484e-14, - "rotation_deg": 9.496717164332357e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 8, - "j": 13, - "lidar_time_i": 1784784474.9314597, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 6878, - "frame_counter_j": 10489, - "rtk_translation_m": 18.245302761704593, - "rtk_rotation_deg": 28.43334478424675, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8712576472135323, - 0.49077303725774324, - 0.007206807389507719, - 17.83885631550189 - ], - [ - -0.4906422418999359, - 0.8712393520770557, - -0.014566463392218697, - 2.209227555174436 - ], - [ - -0.013427681681681741, - 0.009155178488797421, - 0.9998679313146781, - 0.40031079935476305 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 4165, - "backend_objective": 244.0998723263817, - "backend_elapsed_sec": 0.34662629998638295, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3507, - "objective": 1026.1259780030157 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4554, - "objective": 629.4667804436332 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 4165, - "objective": 244.0998723263817 - } - ], - "heldout_symmetric": { - "evaluated": 7808, - "inliers": 2954, - "inlier_ratio": 0.37832991803278687, - "inlier_rmse_m": 0.15442802982944018, - "median_m": 0.36929693670247854, - "p90_m": 2.0301112771069065, - "p95_m": 3.356620420845132 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4639.456002589504, - 11142.092649894259, - 23773.516018542028, - 82142.44887617574, - 177056.34888126588, - 470857.0356533245 - ], - "effective_rank": 6, - "scaled_condition_number": 101.4897081447731, - "weakest_scaled_direction": [ - -0.6711792299500938, - -0.6200237845756325, - -0.004781401182955758, - 0.03916221952861478, - -0.05688790086673817, - 0.4003700455121542 - ] - }, - "forward_reverse": { - "translation_m": 0.027875630486669568, - "rotation_deg": 0.37387837894914167 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5146000066436358e-15, - "rotation_deg": 1.2002448938568858e-14 - }, - { - "translation_m": 2.5989654674417885e-15, - "rotation_deg": 1.110672134964334e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 10, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784614.7244046, - "frame_counter_i": 7623, - "frame_counter_j": 8276, - "rtk_translation_m": 2.04815062353057, - "rtk_rotation_deg": 56.00549858403758, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5585402611504936, - -0.8287865031991155, - -0.033848320326429454, - -0.9276587446874038 - ], - [ - 0.8291802818257895, - 0.5567829749179408, - 0.04952553960162207, - 3.1024518072851404 - ], - [ - -0.022199930298152856, - -0.05572836761030748, - 0.9981991345108691, - -0.0918601778786096 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7538, - "backend_objective": 608.0118186215705, - "backend_elapsed_sec": 0.2677478000114206, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4357, - "objective": 1324.6661052053641 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6291, - "objective": 557.40269090636 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7538, - "objective": 608.0118186215705 - } - ], - "heldout_symmetric": { - "evaluated": 8190, - "inliers": 5386, - "inlier_ratio": 0.6576312576312576, - "inlier_rmse_m": 0.10693844153477818, - "median_m": 0.1288778907124714, - "p90_m": 1.1136753409311773, - "p95_m": 1.7213657641802305 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47269.46473083048, - 69995.82165520151, - 146112.1985207452, - 235663.1375590507, - 454973.5441271389, - 754310.6305504619 - ], - "effective_rank": 6, - "scaled_condition_number": 15.957672354569297, - "weakest_scaled_direction": [ - 0.3979511773838894, - -0.5358952868515874, - -0.015695037907353385, - 0.44537251442255593, - -0.21518509078866688, - -0.556366307241301 - ] - }, - "forward_reverse": { - "translation_m": 0.0038184479242649575, - "rotation_deg": 0.016135929192430513 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 1.2870479187534012e-15, - "rotation_deg": 3.168114144539765e-15 - }, - { - "translation_m": 2.5836590661309904, - "rotation_deg": 6.858156244423453 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 11, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 7623, - "frame_counter_j": 8958, - "rtk_translation_m": 4.738677237611319, - "rtk_rotation_deg": 34.634051469677026, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8218592794898043, - -0.5689630135783226, - -0.028782180187980497, - 1.5818050327821167 - ], - [ - 0.5696826609555828, - 0.8205324215915045, - 0.04677831681182805, - 5.127115738614646 - ], - [ - -0.0029984200950525243, - -0.05484190274830656, - 0.9984905483678247, - 0.018282150203836847 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 6186, - "backend_objective": 608.7584534468984, - "backend_elapsed_sec": 0.35689550000824966, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3870, - "objective": 1072.1342193992616 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5326, - "objective": 755.9554540091757 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 6186, - "objective": 608.7584534468984 - } - ], - "heldout_symmetric": { - "evaluated": 7902, - "inliers": 4649, - "inlier_ratio": 0.5883320678309288, - "inlier_rmse_m": 0.11815838246331245, - "median_m": 0.1732761356088094, - "p90_m": 1.3501275015012313, - "p95_m": 1.810297568884802 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 35779.64456052172, - 55099.034207127086, - 90158.88514826825, - 121972.77920522196, - 341810.39286721504, - 770216.7057141428 - ], - "effective_rank": 6, - "scaled_condition_number": 21.526672921842792, - "weakest_scaled_direction": [ - 0.8136834885680856, - -0.24928441973477838, - -0.011353846441186583, - 0.3132175219694385, - 0.018744214916075416, - -0.42094059796919014 - ] - }, - "forward_reverse": { - "translation_m": 0.008866435423074387, - "rotation_deg": 0.05039949658393549 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.163336342344337e-16, - "rotation_deg": 9.948813902605265e-15 - }, - { - "translation_m": 1.2755491433176288e-15, - "rotation_deg": 1.5746131234065862e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 12, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 7623, - "frame_counter_j": 9717, - "rtk_translation_m": 7.170741483679294, - "rtk_rotation_deg": 16.35622721712263, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9580389060611738, - -0.28583494628803124, - -0.021443832531232578, - 5.206220344183419 - ], - [ - 0.2865026035134924, - 0.9572030750268492, - 0.04096988331853636, - 5.2485799740167325 - ], - [ - 0.008815478041475866, - -0.04539445604544996, - 0.9989302431637751, - 0.10583336091245205 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6103, - "backend_objective": 518.2601822681988, - "backend_elapsed_sec": 0.5235329999995884, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3867, - "objective": 1426.300059188684 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5492, - "objective": 809.5194505361512 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6103, - "objective": 518.2601822681988 - } - ], - "heldout_symmetric": { - "evaluated": 8124, - "inliers": 4398, - "inlier_ratio": 0.5413589364844904, - "inlier_rmse_m": 0.12469816852157387, - "median_m": 0.2078334752819168, - "p90_m": 1.360876011490024, - "p95_m": 1.787772302528427 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18767.9434067404, - 28114.456016397115, - 43095.188369482436, - 150800.6730324435, - 361897.92464180023, - 713847.6342105864 - ], - "effective_rank": 6, - "scaled_condition_number": 38.0354745717217, - "weakest_scaled_direction": [ - 0.9449892265376355, - 0.10758356523122609, - 0.0032027873352404126, - 0.1374104131483723, - 0.08634815676563548, - -0.2628179114040674 - ] - }, - "forward_reverse": { - "translation_m": 0.03403608365914784, - "rotation_deg": 0.249719392637206 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.51548375191671e-11, - "rotation_deg": 2.2703385960631228e-10 - }, - { - "translation_m": 2.5175287103637324e-11, - "rotation_deg": 2.271749122594669e-10 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 13, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 7623, - "frame_counter_j": 10489, - "rtk_translation_m": 10.733928030180744, - "rtk_rotation_deg": 16.40600144552375, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.955934795551706, - 0.29354415476489515, - -0.004527235015012502, - 9.205828284047165 - ], - [ - -0.29341936681268177, - 0.9558097619542706, - 0.018242097800575154, - 4.998375280144739 - ], - [ - 0.009682036602018515, - -0.016109877599909873, - 0.99982334940276, - 0.2662011583595962 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5507, - "backend_objective": 471.20211599619284, - "backend_elapsed_sec": 0.26943060001940466, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3824, - "objective": 1680.1148512546545 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5301, - "objective": 863.2255987553363 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5507, - "objective": 471.20211599619284 - } - ], - "heldout_symmetric": { - "evaluated": 7857, - "inliers": 3988, - "inlier_ratio": 0.5075728649611811, - "inlier_rmse_m": 0.13356609480985904, - "median_m": 0.2438814670298096, - "p90_m": 1.4852497542840035, - "p95_m": 2.008081893939577 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 13201.515080585677, - 42100.58061144254, - 48810.58011128647, - 140947.2209097996, - 310776.03761790437, - 664674.8399612899 - ], - "effective_rank": 6, - "scaled_condition_number": 50.3483756147633, - "weakest_scaled_direction": [ - -0.6866129556117017, - -0.5403756410791841, - 0.0040646757872530494, - 0.020668719932248943, - -0.05020145580139912, - 0.4833145062761431 - ] - }, - "forward_reverse": { - "translation_m": 0.0053243668825205025, - "rotation_deg": 0.1401976908512776 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.305364597889227e-16, - "rotation_deg": 1.1451146831523094e-14 - }, - { - "translation_m": 2.5852944279136686e-15, - "rotation_deg": 3.019679426825962e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 9, - "j": 14, - "lidar_time_i": 1784784549.4274275, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 7623, - "frame_counter_j": 11340, - "rtk_translation_m": 7.8912187855633125, - "rtk_rotation_deg": 14.085282580602351, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9651200333834665, - -0.2612146485288876, - -0.017613306215091305, - 5.2377577927151835 - ], - [ - 0.26167847043212705, - 0.9645721295320843, - 0.03354079668466707, - 6.202530412241703 - ], - [ - 0.008227956866627133, - -0.036979917845631725, - 0.9992821355362713, - 0.10190679759281068 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 5857, - "backend_objective": 534.3183532132553, - "backend_elapsed_sec": 0.2981466999917757, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3826, - "objective": 1175.7687093888226 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5279, - "objective": 675.5257952928124 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 5857, - "objective": 534.3183532132553 - } - ], - "heldout_symmetric": { - "evaluated": 8188, - "inliers": 4435, - "inlier_ratio": 0.5416463116756228, - "inlier_rmse_m": 0.12859551377809317, - "median_m": 0.21150959547510495, - "p90_m": 1.4240677020622226, - "p95_m": 1.8723492575115726 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24277.66112889738, - 35313.23773507953, - 51232.650421287224, - 168805.43646907425, - 339402.4806427054, - 648734.7831650357 - ], - "effective_rank": 6, - "scaled_condition_number": 26.721469573230642, - "weakest_scaled_direction": [ - 0.9523961335282563, - 0.1421400273058059, - -0.0005115147650476002, - 0.1791691525240432, - 0.10073141745058144, - -0.17461143190750852 - ] - }, - "forward_reverse": { - "translation_m": 0.011377143482081005, - "rotation_deg": 0.045883349808202654 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6039333325912283e-07, - "rotation_deg": 1.3581863004148793e-07 - }, - { - "translation_m": 3.210061615366513e-15, - "rotation_deg": 2.035897884802707e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 11, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784682.921899, - "frame_counter_i": 8276, - "frame_counter_j": 8958, - "rtk_translation_m": 3.2047552083250137, - "rtk_rotation_deg": 21.371447114360556, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9314508413496043, - 0.3637994932255433, - -0.007018466923255387, - 3.107744093458173 - ], - [ - -0.3638593544726402, - 0.9313840680347846, - -0.011405611501804977, - -0.968187162602047 - ], - [ - 0.002387532590065103, - 0.013177501273546255, - 0.9999103225531363, - 0.06717614584206823 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 20, - "backend_num_inliers": 7917, - "backend_objective": 1960.5329712839716, - "backend_elapsed_sec": 0.4523613000055775, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4483, - "objective": 1070.74752037691 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6707, - "objective": 914.6379742618799 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 20, - "num_inliers": 7917, - "objective": 1960.5329712839716 - } - ], - "heldout_symmetric": { - "evaluated": 7990, - "inliers": 5698, - "inlier_ratio": 0.7131414267834794, - "inlier_rmse_m": 0.12095106901516857, - "median_m": 0.13597985016316375, - "p90_m": 0.654815430759017, - "p95_m": 0.937070744846754 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 66427.5644095764, - 196624.74014773467, - 295181.1551861929, - 372275.52242307784, - 550663.422299847, - 890408.5165427345 - ], - "effective_rank": 6, - "scaled_condition_number": 13.404202373771971, - "weakest_scaled_direction": [ - 0.011031775994603218, - -0.07488398699455912, - -0.033085995958195405, - 0.9686527638067878, - -0.23254012851851713, - -0.02851170075111955 - ] - }, - "forward_reverse": { - "translation_m": 0.006897671932212844, - "rotation_deg": 0.18540056788520093 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6240489487473085e-15, - "rotation_deg": 9.805240141345259e-15 - }, - { - "translation_m": 7.550332863779066e-16, - "rotation_deg": 5.6161527533700886e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 8276, - "frame_counter_j": 9717, - "rtk_translation_m": 6.291813977735496, - "rtk_rotation_deg": 39.64927136691496, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7725759805259751, - 0.6349211688524118, - 0.001209817100048753, - 5.212004145895133 - ], - [ - -0.6348336094634592, - 0.7724984845669595, - -0.015244003324179146, - -3.903948906740347 - ], - [ - -0.01061332228496872, - 0.011009118258904356, - 0.9998830715164829, - 0.0723992199053718 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7260, - "backend_objective": 723.6829923932979, - "backend_elapsed_sec": 0.29579410000587814, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4141, - "objective": 1364.6826341533097 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6331, - "objective": 774.0528055588874 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7260, - "objective": 723.6829923932979 - } - ], - "heldout_symmetric": { - "evaluated": 8212, - "inliers": 5024, - "inlier_ratio": 0.6117876278616659, - "inlier_rmse_m": 0.125002241212049, - "median_m": 0.17043150415444092, - "p90_m": 1.126473701003775, - "p95_m": 1.6731491720771163 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40394.41642674513, - 65179.81419804479, - 131734.4440523064, - 206960.24969306024, - 516706.69312906166, - 800074.394720169 - ], - "effective_rank": 6, - "scaled_condition_number": 19.806559061723195, - "weakest_scaled_direction": [ - 0.11782910246444485, - -0.08462088371949368, - -0.005297509306259454, - 0.9832693418338864, - 0.08390749755120346, - -0.07119324624117172 - ] - }, - "forward_reverse": { - "translation_m": 0.006509808900811586, - "rotation_deg": 0.06742381610992963 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.630824789273724e-16, - "rotation_deg": 1.2559680439502817e-14 - }, - { - "translation_m": 2.728670952130552e-15, - "rotation_deg": 6.729029131328503e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 13, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 8276, - "frame_counter_j": 10489, - "rtk_translation_m": 10.199392557022867, - "rtk_rotation_deg": 72.41150002956134, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.29025882947499887, - 0.9568820341303022, - -0.011250985310564758, - 7.251141950911897 - ], - [ - -0.9565681268131608, - 0.2897921782619427, - -0.03158974807369129, - -7.380728726628164 - ], - [ - -0.026967214853675838, - 0.01993153724260905, - 0.9994375934225119, - 0.10814934062978022 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6056, - "backend_objective": 356.4176913882986, - "backend_elapsed_sec": 0.2953964000043925, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3970, - "objective": 1284.3243327120063 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5714, - "objective": 678.1439980278099 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6056, - "objective": 356.4176913882986 - } - ], - "heldout_symmetric": { - "evaluated": 7945, - "inliers": 4167, - "inlier_ratio": 0.5244808055380743, - "inlier_rmse_m": 0.13689263771908436, - "median_m": 0.2339437735126918, - "p90_m": 1.6217423638751356, - "p95_m": 2.480595414697209 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18361.276664261397, - 22007.958244877147, - 46300.312308999855, - 72554.1464969259, - 434920.79812304565, - 664354.1886706232 - ], - "effective_rank": 6, - "scaled_condition_number": 36.18235272080672, - "weakest_scaled_direction": [ - 0.8555229864862803, - 0.3006792949355037, - -0.013761971452608485, - 0.011123215109815534, - 0.07883475263508956, - -0.41369595743130916 - ] - }, - "forward_reverse": { - "translation_m": 0.0046518429660042555, - "rotation_deg": 0.17931102925270673 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0137621733714643e-15, - "rotation_deg": 6.4525742777465674e-15 - }, - { - "translation_m": 1.790180836524724e-15, - "rotation_deg": 3.1094093509920868e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 14, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 8276, - "frame_counter_j": 11340, - "rtk_translation_m": 6.819808471778838, - "rtk_rotation_deg": 41.920216003435236, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7557460696051378, - 0.6548477476846684, - -0.004722883515703205, - 6.02645109837871 - ], - [ - -0.6547843528290462, - 0.7555205759810366, - -0.021121329492490282, - -3.4042988172869557 - ], - [ - -0.010263019372187593, - 0.019054831975101296, - 0.9997657644727428, - 0.1059899428415869 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7036, - "backend_objective": 791.3687289870281, - "backend_elapsed_sec": 0.23039960002643056, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4164, - "objective": 1052.0659014095324 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6153, - "objective": 843.4670180931835 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7036, - "objective": 791.3687289870281 - } - ], - "heldout_symmetric": { - "evaluated": 8276, - "inliers": 4963, - "inlier_ratio": 0.5996858385693572, - "inlier_rmse_m": 0.12955691635611957, - "median_m": 0.18147170016897698, - "p90_m": 1.1277348193756978, - "p95_m": 1.645515420506277 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41783.89606331603, - 72609.2001619175, - 129223.05732286548, - 207488.88832643736, - 501543.9834986491, - 748615.21851125 - ], - "effective_rank": 6, - "scaled_condition_number": 17.916357473627098, - "weakest_scaled_direction": [ - -0.01511216788533129, - 0.06474776254351719, - 0.005948136339408654, - -0.993105182982255, - -0.09531389081921925, - 0.014188976431979035 - ] - }, - "forward_reverse": { - "translation_m": 0.009593578345611205, - "rotation_deg": 0.05753783232412823 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9022190146023508e-15, - "rotation_deg": 1.159149537339861e-14 - }, - { - "translation_m": 3.344633236840599e-15, - "rotation_deg": 2.451781459681271e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 15, - "lidar_time_i": 1784784614.7244046, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 8276, - "frame_counter_j": 12056, - "rtk_translation_m": 10.561163834622734, - "rtk_rotation_deg": 65.51298166784417, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4133663127260252, - 0.9105534311559065, - -0.004554175391352016, - 8.211959145727498 - ], - [ - -0.9104277322865137, - 0.4132121256621924, - -0.019418637680553828, - -6.8047147554839045 - ], - [ - -0.01579986667430266, - 0.012173258230156863, - 0.9998010682116402, - 0.18389997201377958 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 5931, - "backend_objective": 425.51722908662924, - "backend_elapsed_sec": 0.2832541999814566, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3963, - "objective": 1154.8125012038524 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5627, - "objective": 627.1119434215982 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 5931, - "objective": 425.51722908662924 - } - ], - "heldout_symmetric": { - "evaluated": 7964, - "inliers": 4021, - "inlier_ratio": 0.5048970366649924, - "inlier_rmse_m": 0.13966622273060364, - "median_m": 0.2466352059576603, - "p90_m": 1.6997910547185842, - "p95_m": 2.6288511706828523 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22858.51135498755, - 39550.79447777227, - 49627.11391869356, - 92977.77775930591, - 386248.5604290127, - 689724.161288384 - ], - "effective_rank": 6, - "scaled_condition_number": 30.173625507677322, - "weakest_scaled_direction": [ - 0.702592645405361, - 0.6965539434222758, - -0.001442226562302501, - -0.10542621618514535, - 0.005892964191415783, - -0.10012334603696395 - ] - }, - "forward_reverse": { - "translation_m": 0.006074999657630774, - "rotation_deg": 0.04867559411570644 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0658801409477063e-15, - "rotation_deg": 1.0723263109506197e-14 - }, - { - "translation_m": 2.1988302645701685e-15, - "rotation_deg": 6.936570407277658e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 12, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784758.8187964, - "frame_counter_i": 8958, - "frame_counter_j": 9717, - "rtk_translation_m": 3.467398797536633, - "rtk_rotation_deg": 18.277824252554396, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9504433935004358, - 0.3108699288544366, - -0.004152479429601264, - 3.0412510252823077 - ], - [ - -0.3108962362764304, - 0.9503946957064814, - -0.009667090675907373, - -1.9624152454246937 - ], - [ - 0.0009412866332746023, - 0.010479012693164157, - 0.9999446506044473, - 0.006938928443856374 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 23, - "backend_num_inliers": 7693, - "backend_objective": 1427.8710136436068, - "backend_elapsed_sec": 0.47855639999033883, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4290, - "objective": 999.096582002139 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6651, - "objective": 1132.2989015074832 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 23, - "num_inliers": 7693, - "objective": 1427.8710136436068 - } - ], - "heldout_symmetric": { - "evaluated": 7924, - "inliers": 5157, - "inlier_ratio": 0.6508076728924785, - "inlier_rmse_m": 0.12017753597340274, - "median_m": 0.14671480883966115, - "p90_m": 0.9401828007833469, - "p95_m": 1.367934426813996 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 57131.84333195028, - 133675.67515040856, - 237033.47281957857, - 305488.1079948467, - 593318.576170641, - 869075.8926799411 - ], - "effective_rank": 6, - "scaled_condition_number": 15.211760062254479, - "weakest_scaled_direction": [ - 0.016444278146483127, - -0.08117415124435234, - -0.01654078390099138, - 0.9922263848513138, - 0.08181679085150644, - -0.04073768885927197 - ] - }, - "forward_reverse": { - "translation_m": 0.016302173123952383, - "rotation_deg": 0.05141023051579345 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8682029553238323e-15, - "rotation_deg": 9.733100321856565e-15 - }, - { - "translation_m": 6.555349938080652e-16, - "rotation_deg": 1.8754138480784483e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 13, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 8958, - "frame_counter_j": 10489, - "rtk_translation_m": 7.516502113110916, - "rtk_rotation_deg": 51.04005291520078, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6182391429232594, - 0.7859851720259684, - 0.0027697495957383633, - 6.214282032960136 - ], - [ - -0.7852674802296215, - 0.6178180190544496, - -0.04069250330781977, - -4.45825153979771 - ], - [ - -0.03369490542107991, - 0.022982704082515897, - 0.9991678781174462, - 0.07675188590804839 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 6443, - "backend_objective": 472.097100200573, - "backend_elapsed_sec": 0.30156139997416176, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4113, - "objective": 1062.5361846990106 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6018, - "objective": 693.7424421423952 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 6443, - "objective": 472.097100200573 - } - ], - "heldout_symmetric": { - "evaluated": 7657, - "inliers": 4339, - "inlier_ratio": 0.5666710199817161, - "inlier_rmse_m": 0.12966061077144844, - "median_m": 0.19703442801383284, - "p90_m": 1.4197259223628946, - "p95_m": 2.079747901535407 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29590.291689393558, - 54337.624830687884, - 67341.03074587212, - 135527.10863196754, - 443725.93536806316, - 773551.7651238618 - ], - "effective_rank": 6, - "scaled_condition_number": 26.14207974844453, - "weakest_scaled_direction": [ - 0.666766807633356, - 0.615172649289733, - -0.0022160018858633558, - -0.05392610294968842, - 0.04492081364211016, - -0.41479370904379287 - ] - }, - "forward_reverse": { - "translation_m": 0.010250004424021303, - "rotation_deg": 0.0630753341579125 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7798229048217483e-15, - "rotation_deg": 2.2026197310775185e-14 - }, - { - "translation_m": 5.551115123125783e-16, - "rotation_deg": 1.4908859356854676e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 14, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 8958, - "frame_counter_j": 11340, - "rtk_translation_m": 3.767517331528496, - "rtk_rotation_deg": 20.548768889074672, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.942026925919612, - 0.3355237071803427, - -0.0030187352328095727, - 3.6069602953031183 - ], - [ - -0.33553665317259207, - 0.9419695375826291, - -0.010418476093145685, - -1.206369087684881 - ], - [ - -0.0006520890906079957, - 0.010827381323624107, - 0.9999411695662349, - 0.07924499098366505 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 7408, - "backend_objective": 1459.8703284439798, - "backend_elapsed_sec": 0.3203974000061862, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4275, - "objective": 1064.8857923542525 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6347, - "objective": 928.3262646342594 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 7408, - "objective": 1459.8703284439798 - } - ], - "heldout_symmetric": { - "evaluated": 7988, - "inliers": 5134, - "inlier_ratio": 0.64271407110666, - "inlier_rmse_m": 0.12109534664165014, - "median_m": 0.15504103975148426, - "p90_m": 0.9524874908970329, - "p95_m": 1.41090815960974 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 61505.82455169954, - 143556.04669624314, - 250928.05845858628, - 375812.23863406415, - 573922.2693983567, - 863904.4673688253 - ], - "effective_rank": 6, - "scaled_condition_number": 14.04589685067402, - "weakest_scaled_direction": [ - 0.01180305193261193, - 0.09185640342475676, - 0.019835137835105623, - -0.9903338151215791, - -0.09689871093297722, - 0.029651827401897906 - ] - }, - "forward_reverse": { - "translation_m": 0.007610676428698485, - "rotation_deg": 0.05350102444543152 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.985625923664639e-13, - "rotation_deg": 2.8826369385899637e-12 - }, - { - "translation_m": 2.8617366805038644e-07, - "rotation_deg": 1.5337474030764892e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 15, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 8958, - "frame_counter_j": 12056, - "rtk_translation_m": 7.712397127778454, - "rtk_rotation_deg": 44.141534553483616, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.716094201727167, - 0.6979874068050286, - 0.004761742782103645, - 6.894343637585203 - ], - [ - -0.6976885985463354, - 0.715959274117259, - -0.02515824445261516, - -3.5712566539558304 - ], - [ - -0.02096935171105586, - 0.014693459329868349, - 0.9996721405249523, - 0.10646586545710361 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 6629, - "backend_objective": 596.9478996131159, - "backend_elapsed_sec": 0.2352178000146523, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4100, - "objective": 1009.2812485827473 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5942, - "objective": 742.3828834104637 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 6629, - "objective": 596.9478996131159 - } - ], - "heldout_symmetric": { - "evaluated": 7676, - "inliers": 4379, - "inlier_ratio": 0.570479416362689, - "inlier_rmse_m": 0.12836105648377344, - "median_m": 0.19583855766353528, - "p90_m": 1.4560376428526856, - "p95_m": 2.062279090391627 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38049.27132401841, - 63332.56476827506, - 71744.68145153238, - 188411.65734390708, - 503547.31521629175, - 717503.9237202356 - ], - "effective_rank": 6, - "scaled_condition_number": 18.857231656557765, - "weakest_scaled_direction": [ - 0.7673350045286186, - 0.4242982572414473, - 0.005601452564885276, - -0.06830701461078995, - 0.047533100756362544, - -0.4735096192724549 - ] - }, - "forward_reverse": { - "translation_m": 0.006898635416764969, - "rotation_deg": 0.028532809525243653 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.131015977260606e-11, - "rotation_deg": 6.110649119113154e-11 - }, - { - "translation_m": 3.794401387868872e-15, - "rotation_deg": 5.500759727794842e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 11, - "j": 16, - "lidar_time_i": 1784784682.921899, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 8958, - "frame_counter_j": 12805, - "rtk_translation_m": 11.0395297023812, - "rtk_rotation_deg": 69.98495270981527, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.33997459216691417, - 0.9404220709679335, - -0.004858509784271119, - 8.665326582789657 - ], - [ - -0.9385271305567985, - 0.33895161243540245, - -0.06541123478626168, - -6.8664357105870675 - ], - [ - -0.05986736915685403, - 0.026798001116207656, - 0.9978465639798603, - -0.023810029264402142 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5353, - "backend_objective": 334.0375475607748, - "backend_elapsed_sec": 0.2557258000015281, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3397, - "objective": 1004.791683813135 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 4966, - "objective": 579.5436701602518 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5353, - "objective": 334.0375475607748 - } - ], - "heldout_symmetric": { - "evaluated": 7922, - "inliers": 3772, - "inlier_ratio": 0.4761423882857864, - "inlier_rmse_m": 0.13515636052103228, - "median_m": 0.27440520801976354, - "p90_m": 1.7053159063617707, - "p95_m": 2.47427889172865 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10127.045516353472, - 24223.753044945723, - 52985.03994164588, - 77287.00801523344, - 338167.59849025833, - 459810.51357045333 - ], - "effective_rank": 6, - "scaled_condition_number": 45.4042112112498, - "weakest_scaled_direction": [ - 0.3754067618118904, - 0.8534683468201325, - 0.0033299375093265252, - -0.020975171147207282, - 0.04313620589694269, - -0.3582593552363523 - ] - }, - "forward_reverse": { - "translation_m": 0.037021121414326036, - "rotation_deg": 0.5129154434742894 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.217454592664719e-15, - "rotation_deg": 1.2677297387073151e-14 - }, - { - "translation_m": 1.807312143953211e-15, - "rotation_deg": 2.5212748876285697e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 12, - "j": 13, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784836.0155501, - "frame_counter_i": 9717, - "frame_counter_j": 10489, - "rtk_translation_m": 4.049286119591895, - "rtk_rotation_deg": 32.762228662646386, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8316727394710671, - 0.5552590632983242, - 0.0027976857848656515, - 3.7890687060066965 - ], - [ - -0.5550814798447131, - 0.8315155678841479, - -0.021596552958877947, - -1.3906575724641173 - ], - [ - -0.014318001050583175, - 0.016408320796838335, - 0.9997628528078737, - 0.11008740201136429 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7953, - "backend_objective": 869.6936700072964, - "backend_elapsed_sec": 0.5297750000027008, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 4370, - "objective": 962.2433630772165 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6858, - "objective": 821.9086325078015 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7953, - "objective": 869.6936700072964 - } - ], - "heldout_symmetric": { - "evaluated": 7879, - "inliers": 5560, - "inlier_ratio": 0.7056733087955325, - "inlier_rmse_m": 0.11689859246507509, - "median_m": 0.12986412584869617, - "p90_m": 0.832358221560291, - "p95_m": 1.2013856283425157 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 57100.09669312741, - 70309.95131630609, - 120136.47232763257, - 230672.1520484908, - 626073.0789463806, - 828508.547965252 - ], - "effective_rank": 6, - "scaled_condition_number": 14.509757355016381, - "weakest_scaled_direction": [ - -0.6854969296403723, - -0.5748624669478345, - 0.00775359846363909, - 0.04562986047685622, - -0.0556223085124074, - 0.4408980152912356 - ] - }, - "forward_reverse": { - "translation_m": 0.0020816591744367207, - "rotation_deg": 0.08889045467662131 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.4365173483345e-13, - "rotation_deg": 1.1223558095281077e-11 - }, - { - "translation_m": 1.1959046253703445e-14, - "rotation_deg": 1.6420504838174178e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 14, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 9717, - "frame_counter_j": 11340, - "rtk_translation_m": 0.97948616772873, - "rtk_rotation_deg": 2.2709446365202806, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9996581263228405, - 0.02610659396280804, - -0.0014409123394368004, - 0.30889730725744324 - ], - [ - -0.026122075707762333, - 0.9995862066640262, - -0.012043778798241984, - 0.9063295399378696 - ], - [ - 0.0011258940566494396, - 0.01207730096851634, - 0.9999264328758839, - 0.006439480993300663 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 10372, - "backend_objective": 1198.5516746258368, - "backend_elapsed_sec": 0.21869030001107603, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4568, - "objective": 795.9998919658881 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7631, - "objective": 637.9132618321958 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 10372, - "objective": 1198.5516746258368 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 7180, - "inlier_ratio": 0.8745432399512789, - "inlier_rmse_m": 0.09766069029332589, - "median_m": 0.08197666179497584, - "p90_m": 0.3146202596650354, - "p95_m": 0.672829810365911 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 109114.22823551347, - 359789.4940437043, - 459655.61713220185, - 844519.4260670365, - 970171.191170407, - 1293820.6527927371 - ], - "effective_rank": 6, - "scaled_condition_number": 11.857488007889668, - "weakest_scaled_direction": [ - -0.003601391110131631, - 0.11329322266653565, - 0.013475728477684981, - -0.9873747958599314, - -0.10269021557784694, - 0.03893343739040223 - ] - }, - "forward_reverse": { - "translation_m": 0.002473515580842477, - "rotation_deg": 0.018069288085025077 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.889675394751205e-07, - "rotation_deg": 3.918435456343839e-07 - }, - { - "translation_m": 9.889675395902287e-07, - "rotation_deg": 3.9184354761591926e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 9717, - "frame_counter_j": 12056, - "rtk_translation_m": 4.286747470271891, - "rtk_rotation_deg": 25.863710300929224, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8972862712213516, - 0.441420931836251, - -0.004990833046564667, - 4.169157063684358 - ], - [ - -0.44144650095283283, - 0.897184424089816, - -0.013604997873056782, - -0.3321808532165975 - ], - [ - -0.0015278331661443911, - 0.014410763596735278, - 0.9998949922958784, - 0.1295301488733824 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8050, - "backend_objective": 1077.6421379499968, - "backend_elapsed_sec": 0.2883843000163324, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4390, - "objective": 807.5217644124835 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 6848, - "objective": 1073.9983012769767 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8050, - "objective": 1077.6421379499968 - } - ], - "heldout_symmetric": { - "evaluated": 7898, - "inliers": 5555, - "inlier_ratio": 0.7033426183844012, - "inlier_rmse_m": 0.12103901189560114, - "median_m": 0.13437732506016573, - "p90_m": 0.7657373090860967, - "p95_m": 1.1689393422349994 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 64933.51746675845, - 73612.68072860739, - 115393.72227781739, - 302897.5851089768, - 659714.9901210441, - 770072.3652140237 - ], - "effective_rank": 6, - "scaled_condition_number": 11.859397045728326, - "weakest_scaled_direction": [ - -0.7011289510728151, - -0.5219313719608661, - -0.009393314541797756, - 0.2600295997417285, - 0.06395736258760248, - 0.40523038583193016 - ] - }, - "forward_reverse": { - "translation_m": 0.022780233796594867, - "rotation_deg": 0.04927694758545139 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.6272671962866384e-15, - "rotation_deg": 1.289339939708841e-14 - }, - { - "translation_m": 6.463236069784172e-16, - "rotation_deg": 3.4338493613969134e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 16, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 9717, - "frame_counter_j": 12805, - "rtk_translation_m": 7.5836501880550475, - "rtk_rotation_deg": 51.70712845726087, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6146203489219709, - 0.7888162783528037, - 0.0032719560918860312, - 6.874101640514283 - ], - [ - -0.7867989688670807, - 0.61333493294241, - -0.0690481181657285, - -2.908082059139103 - ], - [ - -0.05647308456896194, - 0.03986400680015121, - 0.9976079649246516, - 0.062062628879110515 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6703, - "backend_objective": 409.69494126831563, - "backend_elapsed_sec": 0.2799302999919746, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3727, - "objective": 1444.9177421282147 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 5693, - "objective": 557.4885047395345 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6703, - "objective": 409.69494126831563 - } - ], - "heldout_symmetric": { - "evaluated": 8144, - "inliers": 4740, - "inlier_ratio": 0.5820235756385069, - "inlier_rmse_m": 0.12458133956199553, - "median_m": 0.18601408084225746, - "p90_m": 1.194987294606242, - "p95_m": 1.8480348406894138 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18364.402130109076, - 50475.82362826073, - 72295.18416243164, - 85622.68251926747, - 399729.3199221288, - 594122.6450628712 - ], - "effective_rank": 6, - "scaled_condition_number": 32.351864267271, - "weakest_scaled_direction": [ - -0.4363491064464678, - -0.7313957369241603, - -0.0007090641582729063, - 0.0036630210635555348, - -0.045485057920586804, - 0.5220889984698033 - ] - }, - "forward_reverse": { - "translation_m": 0.00989839849833309, - "rotation_deg": 0.03808519306435704 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.7064176995603496e-15, - "rotation_deg": 3.337593529060993e-14 - }, - { - "translation_m": 1.3732700395566711e-15, - "rotation_deg": 2.974763671380339e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 17, - "lidar_time_i": 1784784758.8187964, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 9717, - "frame_counter_j": 14288, - "rtk_translation_m": 6.351478009829798, - "rtk_rotation_deg": 1.4248238883471207, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9994930132691149, - 0.03176504947624508, - -0.002167500402989367, - 6.214675156608227 - ], - [ - -0.031777216054501095, - 0.9994779687978029, - -0.0058308170648675, - 1.2668750661132342 - ], - [ - 0.0019811527075957814, - 0.005896738046589404, - 0.9999806515699989, - 0.168039175109176 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7418, - "backend_objective": 794.1740626832127, - "backend_elapsed_sec": 0.30334379998384975, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4110, - "objective": 1000.8154301262603 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6282, - "objective": 952.1492925664304 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7418, - "objective": 794.1740626832127 - } - ], - "heldout_symmetric": { - "evaluated": 7982, - "inliers": 5222, - "inlier_ratio": 0.6542219994988725, - "inlier_rmse_m": 0.12658997093251892, - "median_m": 0.1569803781567281, - "p90_m": 0.9639560015701379, - "p95_m": 1.4863364576008102 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 58399.48050163931, - 73088.6637050867, - 110601.33854849968, - 181423.41026453133, - 533909.1279579732, - 655823.3109375546 - ], - "effective_rank": 6, - "scaled_condition_number": 11.229951110937455, - "weakest_scaled_direction": [ - 0.8981188066549503, - 0.06658162660065642, - -0.020771352105241295, - 0.12506204124973389, - 0.10764458161261564, - -0.4016094831444013 - ] - }, - "forward_reverse": { - "translation_m": 0.019742680150836883, - "rotation_deg": 0.07899236042083516 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.47711785560036e-08, - "rotation_deg": 7.434739841825308e-08 - }, - { - "translation_m": 4.163798909574513e-15, - "rotation_deg": 7.626668552228922e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 14, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784784921.1126208, - "frame_counter_i": 10489, - "frame_counter_j": 11340, - "rtk_translation_m": 4.006260191078547, - "rtk_rotation_deg": 30.491284026126113, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8458419211807263, - -0.5333682309069453, - -0.00835312112295205, - -4.163012048475338 - ], - [ - 0.5334336026840818, - 0.8457437194742415, - 0.012890015413359665, - -0.02563827897866835 - ], - [ - 0.00018947501035742524, - -0.015358750895558125, - 0.9998820294765522, - -0.12498525406937654 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 7969, - "backend_objective": 927.1435594183387, - "backend_elapsed_sec": 0.2421326999901794, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4371, - "objective": 898.8586398352164 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6619, - "objective": 1040.935285233254 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 7969, - "objective": 927.1435594183387 - } - ], - "heldout_symmetric": { - "evaluated": 7943, - "inliers": 5548, - "inlier_ratio": 0.6984766461034874, - "inlier_rmse_m": 0.11406275231178287, - "median_m": 0.12602217998844806, - "p90_m": 0.903519338084722, - "p95_m": 1.2994502303492355 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50804.88184126566, - 65956.17290397525, - 85728.84407798086, - 229995.28112754674, - 650389.4248986854, - 707443.6587959855 - ], - "effective_rank": 6, - "scaled_condition_number": 13.924718120717541, - "weakest_scaled_direction": [ - 0.7793258965377641, - 0.38266690749821086, - 0.007168629255221333, - -0.2360058333543049, - 0.036974014982615655, - 0.43485625726758553 - ] - }, - "forward_reverse": { - "translation_m": 0.012533581961738958, - "rotation_deg": 0.10861604448395465 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.811417634492977e-15, - "rotation_deg": 2.555001865261242e-14 - }, - { - "translation_m": 3.213209896484438e-15, - "rotation_deg": 1.4494936274853144e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 15, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 10489, - "frame_counter_j": 12056, - "rtk_translation_m": 0.9562774815922267, - "rtk_rotation_deg": 6.898518361717157, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9913539248889289, - -0.13121463619117796, - 0.0003389049016727283, - -0.284327351271054 - ], - [ - 0.13121452196401232, - 0.9913389575266908, - -0.00546081639047433, - 1.0919146226885657 - ], - [ - 0.00038056940405798226, - 0.005458071006458768, - 0.9999850322018909, - -0.016932016341550456 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 10084, - "backend_objective": 1638.7163254148252, - "backend_elapsed_sec": 0.22533139999723062, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4787, - "objective": 819.4918491535332 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7838, - "objective": 907.68020938366 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 10084, - "objective": 1638.7163254148252 - } - ], - "heldout_symmetric": { - "evaluated": 7631, - "inliers": 6711, - "inlier_ratio": 0.8794391298650243, - "inlier_rmse_m": 0.09903209123829654, - "median_m": 0.0794929932661052, - "p90_m": 0.2843674999851667, - "p95_m": 0.553116797826763 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 133310.850116709, - 175848.0556674358, - 230524.304184143, - 890824.1160299031, - 949801.0613552652, - 1401739.4866404298 - ], - "effective_rank": 6, - "scaled_condition_number": 10.514819201987352, - "weakest_scaled_direction": [ - 0.6678512120762216, - 0.24626612198557973, - -0.002692070337053267, - -0.016863926230058553, - 0.08457369218430565, - -0.6970533745920943 - ] - }, - "forward_reverse": { - "translation_m": 0.006638809913641406, - "rotation_deg": 0.04266354358349458 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.053575702315565e-15, - "rotation_deg": 7.241464937813613e-15 - }, - { - "translation_m": 9.436959485696706e-16, - "rotation_deg": 7.257507082768534e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 10489, - "frame_counter_j": 12805, - "rtk_translation_m": 3.565173336606111, - "rtk_rotation_deg": 18.944899794614482, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9489251511944998, - 0.31464278140628316, - 0.023258923866203304, - 3.4130945373445862 - ], - [ - -0.31369495630964817, - 0.9488023328035168, - -0.03700821060918089, - 0.4494671051487981 - ], - [ - -0.03371248754369525, - 0.027821814741736783, - 0.9990442506756612, - 0.04584407398787109 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 8310, - "backend_objective": 890.4256617264003, - "backend_elapsed_sec": 0.3422549999959301, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4122, - "objective": 901.2164938557783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6697, - "objective": 1062.8376030689396 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 8310, - "objective": 890.4256617264003 - } - ], - "heldout_symmetric": { - "evaluated": 7877, - "inliers": 5729, - "inlier_ratio": 0.7273073505141552, - "inlier_rmse_m": 0.10958532316684438, - "median_m": 0.11088671307791485, - "p90_m": 0.6526082260217301, - "p95_m": 1.0313552461224216 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50138.26586802238, - 75062.54890217083, - 130722.92080997657, - 299118.1598858921, - 768567.2732860111, - 972935.8821858894 - ], - "effective_rank": 6, - "scaled_condition_number": 19.40505650408657, - "weakest_scaled_direction": [ - -0.38672167429684523, - -0.6532940659090329, - -0.0024710847024261564, - 0.024890199464270537, - -0.02032408794266449, - 0.6500880811377863 - ] - }, - "forward_reverse": { - "translation_m": 0.005441055528592516, - "rotation_deg": 0.12519365495730794 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4049503905841223e-15, - "rotation_deg": 3.70702022880602e-15 - }, - { - "translation_m": 2.8522145930998398e-15, - "rotation_deg": 3.402144189154636e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 17, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 10489, - "frame_counter_j": 14288, - "rtk_translation_m": 2.967150651379281, - "rtk_rotation_deg": 31.337404774299262, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8489495177179236, - -0.528332223669453, - -0.012238374033990258, - 0.5419932722823791 - ], - [ - 0.5284484316622716, - 0.8489084395372175, - 0.00983444742587709, - 3.556042865317767 - ], - [ - 0.005193403526593496, - -0.014816298963579038, - 0.9998767453265581, - 0.0404797123576018 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 7967, - "backend_objective": 1111.9187402346486, - "backend_elapsed_sec": 0.29831579999881797, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4309, - "objective": 920.5379342221945 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6597, - "objective": 1098.5312376041902 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 7967, - "objective": 1111.9187402346486 - } - ], - "heldout_symmetric": { - "evaluated": 7715, - "inliers": 5501, - "inlier_ratio": 0.7130265716137395, - "inlier_rmse_m": 0.11779895987026284, - "median_m": 0.13060126881310336, - "p90_m": 0.7839507232547154, - "p95_m": 1.2257874058501432 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 59654.597100181374, - 127705.55415331507, - 154997.31781970174, - 484842.7934717072, - 664238.141275342, - 764556.613382757 - ], - "effective_rank": 6, - "scaled_condition_number": 12.816390530620689, - "weakest_scaled_direction": [ - -0.825518074746113, - -0.28261208492193335, - -0.003827921662312285, - 0.039473874928980246, - -0.09616863988319821, - 0.4773144358181554 - ] - }, - "forward_reverse": { - "translation_m": 0.013263327701592687, - "rotation_deg": 0.16221305155705806 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.094764613337708e-15, - "rotation_deg": 1.9179512446675555e-14 - }, - { - "translation_m": 1.3340734093775516e-15, - "rotation_deg": 1.990236080151568e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 18, - "lidar_time_i": 1784784836.0155501, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 10489, - "frame_counter_j": 15094, - "rtk_translation_m": 5.249882044431148, - "rtk_rotation_deg": 3.4459964529377567, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9977571417147861, - -0.0667962881856638, - -0.004352245599464723, - 2.936043866868282 - ], - [ - 0.0667959258106268, - 0.9977666320230834, - -0.00022872782023320318, - 4.434809149161473 - ], - [ - 0.004357803602911574, - -6.24974580249391e-05, - 0.9999905027758146, - 0.11203964846465073 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7543, - "backend_objective": 841.8866254288604, - "backend_elapsed_sec": 0.2504865999799222, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4277, - "objective": 793.0656724866166 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6560, - "objective": 958.332626200767 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7543, - "objective": 841.8866254288604 - } - ], - "heldout_symmetric": { - "evaluated": 7446, - "inliers": 5227, - "inlier_ratio": 0.7019876443728176, - "inlier_rmse_m": 0.11940768524727291, - "median_m": 0.13180635915653727, - "p90_m": 0.857866015488963, - "p95_m": 1.5608407355086427 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33811.95297915407, - 74476.92295847525, - 139856.87652361512, - 336907.90021488024, - 602828.555566902, - 878620.0541353419 - ], - "effective_rank": 6, - "scaled_condition_number": 25.985486690964983, - "weakest_scaled_direction": [ - 0.5771258940496528, - 0.6404774288226794, - -0.0027055542924389717, - -0.05116004191354056, - 0.055856331158730524, - -0.500968827316571 - ] - }, - "forward_reverse": { - "translation_m": 0.008995185113784413, - "rotation_deg": 0.05198334813202341 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.264917572290597e-16, - "rotation_deg": 3.2565984009314428e-15 - }, - { - "translation_m": 4.742874840267547e-16, - "rotation_deg": 5.494358663589623e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784784992.709947, - "frame_counter_i": 11340, - "frame_counter_j": 12056, - "rtk_translation_m": 4.019575892829469, - "rtk_rotation_deg": 23.592765664408944, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9085170701592518, - 0.41783878252876905, - -0.002735880868219632, - 3.8911482014585665 - ], - [ - -0.4178475701601259, - 0.9085031190204823, - -0.005048845544674135, - -1.1353852142585041 - ], - [ - 0.00037595282648356077, - 0.005730143534967087, - 0.9999835119213423, - 0.16406336153145454 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7966, - "backend_objective": 902.9205965703671, - "backend_elapsed_sec": 0.2668874000082724, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4290, - "objective": 958.6151327290297 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6698, - "objective": 1275.2840755374373 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7966, - "objective": 902.9205965703671 - } - ], - "heldout_symmetric": { - "evaluated": 7962, - "inliers": 5602, - "inlier_ratio": 0.7035920622959055, - "inlier_rmse_m": 0.12189498753760801, - "median_m": 0.13573370144706748, - "p90_m": 0.810941644922927, - "p95_m": 1.3610394034846007 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68945.42428668191, - 77582.4108575915, - 116985.42825515481, - 197764.31044804805, - 616820.4872774186, - 709858.1746199143 - ], - "effective_rank": 6, - "scaled_condition_number": 10.295943232842452, - "weakest_scaled_direction": [ - -0.08533000640036743, - -0.29768613088104035, - -0.009596037934023782, - 0.8292050077175325, - 0.46520946393242857, - 0.0029805014053541678 - ] - }, - "forward_reverse": { - "translation_m": 0.010817230757509965, - "rotation_deg": 0.008099442158890762 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 2.0905310879782476e-15, - "rotation_deg": 1.611090055341308e-14 - }, - { - "translation_m": 0.08606585746770694, - "rotation_deg": 0.8387443181814452 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 16, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 11340, - "frame_counter_j": 12805, - "rtk_translation_m": 7.5676649485439835, - "rtk_rotation_deg": 49.43618382074059, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6349122470255462, - 0.7725608831825928, - 0.006010021056944039, - 6.655705349267587 - ], - [ - -0.7709997280782875, - 0.6340888682829757, - -0.059082369813874124, - -3.6396657145186144 - ], - [ - -0.049455615254281604, - 0.032878395577472457, - 0.9982350190331288, - 0.06220101301599634 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6708, - "backend_objective": 387.4594836405733, - "backend_elapsed_sec": 0.24329849999048747, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3600, - "objective": 1289.3156658433 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5585, - "objective": 460.5022697437489 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6708, - "objective": 387.4594836405733 - } - ], - "heldout_symmetric": { - "evaluated": 8208, - "inliers": 4862, - "inlier_ratio": 0.5923489278752436, - "inlier_rmse_m": 0.12241126089476961, - "median_m": 0.17858216608738586, - "p90_m": 1.2951310482418497, - "p95_m": 1.9536327645697338 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18839.99127827367, - 44246.580454990275, - 71798.78942804766, - 81252.29609650953, - 400147.1512237064, - 634034.6025680369 - ], - "effective_rank": 6, - "scaled_condition_number": 33.65365690477826, - "weakest_scaled_direction": [ - 0.42183630237970215, - 0.7931639495655218, - -0.005825229284865469, - -0.010288172641256362, - 0.04591388166329985, - -0.43668892679152543 - ] - }, - "forward_reverse": { - "translation_m": 0.003104373432332903, - "rotation_deg": 0.13386003286196627 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.7499872543679206e-07, - "rotation_deg": 3.650840534413396e-07 - }, - { - "translation_m": 3.74998724994446e-07, - "rotation_deg": 3.650840466010599e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 17, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 11340, - "frame_counter_j": 14288, - "rtk_translation_m": 5.910977627463022, - "rtk_rotation_deg": 0.8461207481731591, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9999810311615547, - 0.005256007544014506, - 0.0032111838581707084, - 5.886999225033465 - ], - [ - -0.005263753844837616, - 0.9999832455873373, - 0.0024086178766968913, - 0.5172458084494828 - ], - [ - -0.003198470342940645, - -0.0024254750693934388, - 0.9999919433966221, - 0.14574668511076191 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7592, - "backend_objective": 978.1514630810549, - "backend_elapsed_sec": 0.23258599999826401, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4104, - "objective": 1018.089983840903 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6315, - "objective": 795.6756085182283 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7592, - "objective": 978.1514630810549 - } - ], - "heldout_symmetric": { - "evaluated": 8046, - "inliers": 5381, - "inlier_ratio": 0.6687795177728063, - "inlier_rmse_m": 0.12452036369759786, - "median_m": 0.1504837039015933, - "p90_m": 0.8884399853069347, - "p95_m": 1.4154431558457168 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 78482.02592436179, - 85000.72426497057, - 140118.92499435777, - 200075.4481312525, - 527280.7777253377, - 702653.6176268102 - ], - "effective_rank": 6, - "scaled_condition_number": 8.95305147071513, - "weakest_scaled_direction": [ - 0.6682663506337039, - -0.12573044567191893, - -0.04161918367411972, - 0.6728833238532822, - 0.1486228302734804, - -0.24702038376176852 - ] - }, - "forward_reverse": { - "translation_m": 0.01159286549234958, - "rotation_deg": 0.10132041390926738 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.637438791077969e-07, - "rotation_deg": 4.734803485491884e-07 - }, - { - "translation_m": 2.190454440024561e-08, - "rotation_deg": 1.5774695801797192e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 18, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 11340, - "frame_counter_j": 15094, - "rtk_translation_m": 8.548241724186095, - "rtk_rotation_deg": 27.045287573188347, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8796843299610488, - 0.47554326950822207, - 0.003752125585852792, - 8.386652041996692 - ], - [ - -0.4754753480973043, - 0.8796510895953867, - -0.011711273431879549, - -0.01463790464529569 - ], - [ - -0.008869778617794907, - 0.00851818050287543, - 0.9999243809549762, - 0.18329554143287938 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7035, - "backend_objective": 678.2874870199292, - "backend_elapsed_sec": 0.21809029998257756, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3921, - "objective": 1152.3067795625525 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5991, - "objective": 616.5435255495543 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7035, - "objective": 678.2874870199292 - } - ], - "heldout_symmetric": { - "evaluated": 7777, - "inliers": 4819, - "inlier_ratio": 0.6196476790536196, - "inlier_rmse_m": 0.12845393182350578, - "median_m": 0.1731602947244192, - "p90_m": 1.2571440001147722, - "p95_m": 1.9928971214320321 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 40431.25205982152, - 75564.08180304668, - 90949.10875347017, - 123277.63194673136, - 432859.04912703205, - 719898.8698119103 - ], - "effective_rank": 6, - "scaled_condition_number": 17.805505225184664, - "weakest_scaled_direction": [ - -0.6794571416531119, - -0.7022532493594741, - 0.0012572727446779881, - 0.006708870553632756, - -0.0765369796544835, - 0.19817635451070353 - ] - }, - "forward_reverse": { - "translation_m": 0.010070495463159433, - "rotation_deg": 0.13041926369959572 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0547118733938987e-15, - "rotation_deg": 7.049615762303467e-15 - }, - { - "translation_m": 1.6014269617894046e-15, - "rotation_deg": 1.226560617416122e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 19, - "lidar_time_i": 1784784921.1126208, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 11340, - "frame_counter_j": 15761, - "rtk_translation_m": 9.249254057266956, - "rtk_rotation_deg": 79.47127430600668, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.16864462120307008, - 0.9856558183330172, - -0.006449769417807938, - 8.028845027944058 - ], - [ - -0.9841353949736018, - 0.1680114525860001, - -0.0570059309203547, - -3.086991614382891 - ], - [ - -0.05510459236240697, - 0.015961189999874656, - 0.9983530058623359, - 0.12073617114424255 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6469, - "backend_objective": 441.0332153778222, - "backend_elapsed_sec": 0.22742700000526384, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 3355, - "objective": 718.9129117928787 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5297, - "objective": 547.1775931939246 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6469, - "objective": 441.0332153778222 - } - ], - "heldout_symmetric": { - "evaluated": 8112, - "inliers": 4742, - "inlier_ratio": 0.5845660749506904, - "inlier_rmse_m": 0.12584132662356784, - "median_m": 0.18632614571820721, - "p90_m": 1.2545048509935826, - "p95_m": 1.7995966868342481 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20396.428174903343, - 39202.1818399841, - 72169.12531908663, - 84188.99712048641, - 347318.5542943997, - 618731.203703752 - ], - "effective_rank": 6, - "scaled_condition_number": 30.335272352492872, - "weakest_scaled_direction": [ - -0.008377089592741012, - -0.8800967663169411, - 0.012677412919848172, - 0.028982638826861546, - -0.03291253049716893, - 0.4725204349792536 - ] - }, - "forward_reverse": { - "translation_m": 0.016830803029542436, - "rotation_deg": 0.2574761671757917 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.485749680535094e-16, - "rotation_deg": 4.7858488900142276e-15 - }, - { - "translation_m": 3.824646945720487e-08, - "rotation_deg": 2.990864239737409e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 16, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785067.6067727, - "frame_counter_i": 12056, - "frame_counter_j": 12805, - "rtk_translation_m": 3.7301261399251735, - "rtk_rotation_deg": 25.84341815633164, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8992976777543386, - 0.43674267702152464, - 0.022793000103672113, - 3.5719600246891323 - ], - [ - -0.435676317216372, - 0.8992027959867313, - -0.04025516496580931, - -1.1219973503743492 - ], - [ - -0.03807667793325846, - 0.026271006027889867, - 0.9989294273570327, - 0.013785246908084234 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8047, - "backend_objective": 677.6641874672224, - "backend_elapsed_sec": 0.46031090000178665, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4045, - "objective": 944.0731860097742 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6516, - "objective": 703.732504367553 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8047, - "objective": 677.6641874672224 - } - ], - "heldout_symmetric": { - "evaluated": 7896, - "inliers": 5553, - "inlier_ratio": 0.7032674772036475, - "inlier_rmse_m": 0.11602216892855616, - "median_m": 0.12856434316622817, - "p90_m": 0.8237440138060417, - "p95_m": 1.249103905675259 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 46006.88661431607, - 89386.44791066805, - 126549.715838319, - 258894.6678202254, - 761451.6775041186, - 1044213.2886563556 - ], - "effective_rank": 6, - "scaled_condition_number": 22.696890954829907, - "weakest_scaled_direction": [ - 0.2762530279556851, - 0.7885899512178404, - 0.009052518246365292, - -0.03752590959284089, - 0.015068193732708488, - -0.5478074122753568 - ] - }, - "forward_reverse": { - "translation_m": 0.0009988867448423883, - "rotation_deg": 0.09036168134112703 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.496487509300926e-07, - "rotation_deg": 1.8603225390632326e-06 - }, - { - "translation_m": 5.5689195279226995e-15, - "rotation_deg": 1.444178934938382e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 12056, - "frame_counter_j": 14288, - "rtk_translation_m": 2.2049738368271745, - "rtk_rotation_deg": 24.438886412582093, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9108869875354506, - -0.4125846265933177, - -0.007669539584862537, - 1.137127467449205 - ], - [ - 0.41264758822687425, - 0.9108292929501547, - 0.010581447654499285, - 2.337090897611843 - ], - [ - 0.0026198986879852415, - -0.01280331999027499, - 0.9999146019176293, - 0.0014113832191833349 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8481, - "backend_objective": 1411.3543687050185, - "backend_elapsed_sec": 0.32633010001154616, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4406, - "objective": 1048.0658041408024 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6942, - "objective": 1184.8493873034854 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8481, - "objective": 1411.3543687050185 - } - ], - "heldout_symmetric": { - "evaluated": 7734, - "inliers": 5792, - "inlier_ratio": 0.7489009568140678, - "inlier_rmse_m": 0.11923375870790391, - "median_m": 0.12228074153052311, - "p90_m": 0.6399208318778252, - "p95_m": 1.0259624076068736 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 116187.99654779934, - 139885.37269974177, - 161757.95725716965, - 550664.2422881951, - 751625.9731662428, - 806916.9372316723 - ], - "effective_rank": 6, - "scaled_condition_number": 6.944925131742929, - "weakest_scaled_direction": [ - 0.8512941529709663, - 0.39602818804055295, - 0.007439589220697924, - -0.19259023763953056, - 0.09563504495527503, - -0.26864015047892764 - ] - }, - "forward_reverse": { - "translation_m": 0.02582458487951314, - "rotation_deg": 0.095039680889365 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.715952546737407e-14, - "rotation_deg": 7.886538886890109e-13 - }, - { - "translation_m": 1.088109979028084e-07, - "rotation_deg": 4.773299735272517e-07 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 12056, - "frame_counter_j": 15094, - "rtk_translation_m": 4.7000039832559155, - "rtk_rotation_deg": 3.452521908779401, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9979119148987198, - 0.06458109882961766, - -0.0010448813947702214, - 3.625977126782013 - ], - [ - -0.06457946758945692, - 0.9979114005357889, - 0.001526121411667174, - 2.8920498347958117 - ], - [ - 0.0011412576537618143, - -0.0014554568561163375, - 0.9999982895866913, - 0.12402487360318108 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8033, - "backend_objective": 1109.9035314686819, - "backend_elapsed_sec": 0.2834294000058435, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4322, - "objective": 1072.150891932064 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6681, - "objective": 1042.5162725642767 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8033, - "objective": 1109.9035314686819 - } - ], - "heldout_symmetric": { - "evaluated": 7465, - "inliers": 5349, - "inlier_ratio": 0.7165438713998661, - "inlier_rmse_m": 0.11783922962071142, - "median_m": 0.13030031278079807, - "p90_m": 0.8690573063958871, - "p95_m": 1.5526475747415203 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51927.807327871626, - 86642.60862666558, - 155545.85956133596, - 373029.6265212382, - 789682.7347752531, - 1003980.8086995601 - ], - "effective_rank": 6, - "scaled_condition_number": 19.334165264487982, - "weakest_scaled_direction": [ - -0.5802503351084414, - -0.6445267211977116, - -0.008012710232842335, - 0.07662723130540065, - -0.04869576731771482, - 0.48947690488030343 - ] - }, - "forward_reverse": { - "translation_m": 0.009354386824208725, - "rotation_deg": 0.17478401338848865 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.198774900268694e-14, - "rotation_deg": 9.175874595023294e-12 - }, - { - "translation_m": 1.5265566588595902e-16, - "rotation_deg": 1.6705760377223011e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 19, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 12056, - "frame_counter_j": 15761, - "rtk_translation_m": 5.238340351181781, - "rtk_rotation_deg": 55.87850864159773, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5645701896065889, - 0.8253654397768558, - 0.005691382041061125, - 4.587045087231857 - ], - [ - -0.8243392754522068, - 0.5641884597246338, - -0.046434263862749445, - -0.046454652733170926 - ], - [ - -0.04153624868124346, - 0.021523771405184824, - 0.9989051342895319, - 0.08465923636290916 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7699, - "backend_objective": 767.9166797724031, - "backend_elapsed_sec": 0.2584838999900967, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3854, - "objective": 1076.8824304773595 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6216, - "objective": 769.177723471952 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7699, - "objective": 767.9166797724031 - } - ], - "heldout_symmetric": { - "evaluated": 7800, - "inliers": 5401, - "inlier_ratio": 0.6924358974358974, - "inlier_rmse_m": 0.11506895717743916, - "median_m": 0.1289445617051141, - "p90_m": 0.8453403966703839, - "p95_m": 1.3063421797625605 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44233.04006452315, - 51153.742344676786, - 124036.93051460973, - 241430.67313910907, - 709925.1177656525, - 903111.5561031906 - ], - "effective_rank": 6, - "scaled_condition_number": 20.41712608461488, - "weakest_scaled_direction": [ - 0.06573189305138759, - -0.7784808250314448, - 0.008064223538009183, - 0.03451032811327412, - 0.024686991637438926, - 0.6227210300691461 - ] - }, - "forward_reverse": { - "translation_m": 0.012497900854287812, - "rotation_deg": 0.3255615001296644 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.279719709729456e-15, - "rotation_deg": 6.057362871732031e-15 - }, - { - "translation_m": 1.023951298512e-15, - "rotation_deg": 7.257282718757611e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 20, - "lidar_time_i": 1784784992.709947, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 12056, - "frame_counter_j": 16475, - "rtk_translation_m": 2.0380809160783224, - "rtk_rotation_deg": 128.5450420215843, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6180248070205486, - 0.7853863257460557, - -0.03483758370389297, - -2.9183118830256083 - ], - [ - -0.7835683183308679, - -0.6189776875497679, - -0.05373372147618209, - -2.894884817530272 - ], - [ - -0.06376541707969742, - -0.005911145968243088, - 0.9979474084028651, - -0.1432165250889545 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7352, - "backend_objective": 583.297661455954, - "backend_elapsed_sec": 0.574083099985728, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 4086, - "objective": 883.4481821360966 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 6296, - "objective": 603.2673124443803 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7352, - "objective": 583.297661455954 - } - ], - "heldout_symmetric": { - "evaluated": 7629, - "inliers": 5151, - "inlier_ratio": 0.6751867872591427, - "inlier_rmse_m": 0.11901811643083532, - "median_m": 0.14159789712511092, - "p90_m": 1.0382608333446528, - "p95_m": 1.821192338489586 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24123.63768676933, - 38534.47857860633, - 74192.33144082606, - 304072.57505885523, - 604766.940623593, - 660546.5064511801 - ], - "effective_rank": 6, - "scaled_condition_number": 27.381712286843808, - "weakest_scaled_direction": [ - 0.8702933981126788, - -0.2707296754933225, - 0.03355380132624614, - -0.0011379634830684894, - 0.07150849524573777, - 0.4037997357256773 - ] - }, - "forward_reverse": { - "translation_m": 0.007126007329084919, - "rotation_deg": 0.09473387178666172 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.815927141515099e-07, - "rotation_deg": 7.01362978167917e-06 - }, - { - "translation_m": 3.857226206275732e-15, - "rotation_deg": 1.2674795752764449e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 17, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785215.9006598, - "frame_counter_i": 12805, - "frame_counter_j": 14288, - "rtk_translation_m": 3.368526196086246, - "rtk_rotation_deg": 50.282304568913744, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6394669809345536, - -0.7673958414205374, - -0.04675043170830751, - -3.696317013339254 - ], - [ - 0.7687927199496203, - 0.6387607379184163, - 0.03069973039597831, - 2.048292343528662 - ], - [ - 0.006303494817397596, - -0.055572855463669635, - 0.9984347368199389, - -0.1872402600565715 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6460, - "backend_objective": 537.9167698023417, - "backend_elapsed_sec": 0.2466442000004463, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3991, - "objective": 1215.4056887644454 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5641, - "objective": 582.2921483368284 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6460, - "objective": 537.9167698023417 - } - ], - "heldout_symmetric": { - "evaluated": 7980, - "inliers": 5015, - "inlier_ratio": 0.6284461152882206, - "inlier_rmse_m": 0.1113618900510703, - "median_m": 0.144408219715569, - "p90_m": 1.1991709577636944, - "p95_m": 1.7133251503963587 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22632.024033943286, - 51169.81471120535, - 101486.72079659617, - 212358.80836223956, - 404083.44617557, - 569965.0089348503 - ], - "effective_rank": 6, - "scaled_condition_number": 25.184005110635376, - "weakest_scaled_direction": [ - 0.7976249939076281, - 0.29447002675707135, - 0.011870781607846525, - -0.00500893768036564, - 0.07710372421815591, - -0.5205485407092886 - ] - }, - "forward_reverse": { - "translation_m": 0.015370940622322818, - "rotation_deg": 0.07520125332617648 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1743442292980627e-15, - "rotation_deg": 4.6184430945386335e-15 - }, - { - "translation_m": 7.008488945675242e-15, - "rotation_deg": 5.806321477459788e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 18, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 12805, - "frame_counter_j": 15094, - "rtk_translation_m": 3.5240348999326185, - "rtk_rotation_deg": 22.39089624755224, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9255542303464891, - -0.37658036896538655, - -0.03919939282198775, - -1.7046279048583803 - ], - [ - 0.3777114391060465, - 0.9255319342048977, - 0.02692039255622169, - 3.633427584849505 - ], - [ - 0.026142598496676897, - -0.03972234228787535, - 0.9988687101251127, - -0.06558745181347346 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6968, - "backend_objective": 523.1707509471478, - "backend_elapsed_sec": 0.22624720001476817, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4121, - "objective": 1018.0747415048886 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6101, - "objective": 671.6853579970308 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6968, - "objective": 523.1707509471478 - } - ], - "heldout_symmetric": { - "evaluated": 7711, - "inliers": 5337, - "inlier_ratio": 0.6921281286473868, - "inlier_rmse_m": 0.10919235768364483, - "median_m": 0.12047214706280118, - "p90_m": 1.043079207156195, - "p95_m": 1.5481102788596193 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29120.049026715784, - 60387.51926125168, - 145352.913746165, - 297167.32794772723, - 585893.0897598492, - 1148181.0798230364 - ], - "effective_rank": 6, - "scaled_condition_number": 39.42922894015919, - "weakest_scaled_direction": [ - -0.5523616474072939, - -0.425660064296291, - -0.0113183500735427, - 0.028772987244752694, - -0.05542125155791058, - 0.7139205944425184 - ] - }, - "forward_reverse": { - "translation_m": 0.005355462743716769, - "rotation_deg": 0.03654303027439279 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.826392801036703e-15, - "rotation_deg": 4.094903114022454e-15 - }, - { - "translation_m": 5.03754139627894e-15, - "rotation_deg": 1.5331683708932568e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 19, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 12805, - "frame_counter_j": 15761, - "rtk_translation_m": 2.146829294717985, - "rtk_rotation_deg": 30.035090485266103, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8684801522066371, - 0.4956975347175394, - -0.005116570930846743, - 0.4366470307130142 - ], - [ - -0.4957238908605204, - 0.8684384244754766, - -0.008516274106638735, - 1.4052579477847364 - ], - [ - 0.00022193071826193039, - 0.009932621482070235, - 0.9999506456707004, - 0.03001666405700953 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9165, - "backend_objective": 1083.0467328585598, - "backend_elapsed_sec": 0.22576579998712987, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4137, - "objective": 628.5904983483101 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7105, - "objective": 731.1875091234955 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9165, - "objective": 1083.0467328585598 - } - ], - "heldout_symmetric": { - "evaluated": 8046, - "inliers": 7145, - "inlier_ratio": 0.8880188913745961, - "inlier_rmse_m": 0.0968346861370537, - "median_m": 0.07327330233977344, - "p90_m": 0.27608481806151036, - "p95_m": 0.4577456992353155 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 126380.21761596165, - 151352.82425205142, - 254232.47885422912, - 569669.4774072361, - 828900.8291876996, - 1479797.8866744747 - ], - "effective_rank": 6, - "scaled_condition_number": 11.70909430755386, - "weakest_scaled_direction": [ - -0.1016208027551598, - -0.694125913481962, - -0.05326251190352323, - 0.005523485332426906, - -0.21833356557136124, - 0.6762584408054617 - ] - }, - "forward_reverse": { - "translation_m": 0.006745004702225108, - "rotation_deg": 0.04851926363283949 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.410219892462108e-16, - "rotation_deg": 3.6574997703043804e-15 - }, - { - "translation_m": 1.3280732962197467e-15, - "rotation_deg": 5.326978507324993e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 20, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 12805, - "frame_counter_j": 16475, - "rtk_translation_m": 4.728364693236263, - "rtk_rotation_deg": 102.70162386525263, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.21255684919093382, - 0.9759059311703469, - -0.049266615152274276, - -5.055551407751126 - ], - [ - -0.976722894802377, - -0.2136822895360795, - -0.01876874815978336, - -4.447241576850858 - ], - [ - -0.028843935773205966, - 0.044130404996542215, - 0.9986093003392027, - -0.20611839197809104 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 6554, - "backend_objective": 426.5789434001036, - "backend_elapsed_sec": 0.21484369999961928, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3938, - "objective": 1050.4660865507365 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5931, - "objective": 611.5231853974067 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 6554, - "objective": 426.5789434001036 - } - ], - "heldout_symmetric": { - "evaluated": 7875, - "inliers": 4967, - "inlier_ratio": 0.6307301587301587, - "inlier_rmse_m": 0.12362874516637085, - "median_m": 0.16231191866763003, - "p90_m": 1.1140320549033425, - "p95_m": 1.788569027355814 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14237.517771017796, - 47249.74092295492, - 72921.91702690597, - 150177.7990673665, - 435241.0965762853, - 508286.2314982878 - ], - "effective_rank": 6, - "scaled_condition_number": 35.70048091760535, - "weakest_scaled_direction": [ - 0.8310814266371664, - -0.3059721702444007, - 0.025914629425142315, - 0.01150043826748368, - 0.06204267849468339, - 0.4593817271956763 - ] - }, - "forward_reverse": { - "translation_m": 0.007128919591300971, - "rotation_deg": 0.10475436005961275 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.699381867227797e-07, - "rotation_deg": 4.039327925839266e-06 - }, - { - "translation_m": 2.470662620641947e-12, - "rotation_deg": 5.6053474906106605e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 21, - "lidar_time_i": 1784785067.6067727, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 12805, - "frame_counter_j": 17193, - "rtk_translation_m": 10.094336026449797, - "rtk_rotation_deg": 153.311489607007, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8899984345917292, - 0.4494142546077488, - -0.0770039880761356, - -9.274713964325178 - ], - [ - -0.4491512976198232, - -0.8931926093274017, - -0.021681201289020256, - -8.008563415626913 - ], - [ - -0.07852323395464522, - 0.015290205959001577, - 0.9967950197162088, - -0.43062149481783685 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 4644, - "backend_objective": 266.9854804589645, - "backend_elapsed_sec": 0.42213180000544526, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3710, - "objective": 1440.2026338509213 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4866, - "objective": 663.1837238321684 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 4644, - "objective": 266.9854804589645 - } - ], - "heldout_symmetric": { - "evaluated": 8113, - "inliers": 3283, - "inlier_ratio": 0.40465918895599656, - "inlier_rmse_m": 0.14174574821871383, - "median_m": 0.3669682112816362, - "p90_m": 1.9181229457011237, - "p95_m": 2.7584674923427643 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6427.858596617149, - 13985.619800098873, - 35674.316533521705, - 62318.95281829014, - 238260.65846745667, - 368102.50009519083 - ], - "effective_rank": 6, - "scaled_condition_number": 57.2667389243621, - "weakest_scaled_direction": [ - 0.7752852060782287, - 0.6043573613745785, - 0.03703808362227075, - -0.03503243337133707, - 0.05774669529164447, - -0.16658708576946268 - ] - }, - "forward_reverse": { - "translation_m": 0.01442382622115287, - "rotation_deg": 0.2621394134233604 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.2203492502216944e-14, - "rotation_deg": 4.354630933060622e-14 - }, - { - "translation_m": 2.939518572217377e-14, - "rotation_deg": 2.4348951708484345e-13 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 18, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785296.4990919, - "frame_counter_i": 14288, - "frame_counter_j": 15094, - "rtk_translation_m": 2.640403049812329, - "rtk_rotation_deg": 27.891408321361506, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8821126233718427, - 0.4709554229763278, - -0.008849251789510982, - 2.500926515503556 - ], - [ - -0.4710229621929244, - 0.8820806066082816, - -0.008436381485460649, - -0.5222544407418006 - ], - [ - 0.0038325937756464863, - 0.01161003939499183, - 0.9999252563117895, - 0.04293224683626978 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8617, - "backend_objective": 1317.2217546929442, - "backend_elapsed_sec": 0.25503369999933057, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4424, - "objective": 1069.9385022645633 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 7103, - "objective": 1010.8939072081614 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8617, - "objective": 1317.2217546929442 - } - ], - "heldout_symmetric": { - "evaluated": 7549, - "inliers": 5787, - "inlier_ratio": 0.7665916015366274, - "inlier_rmse_m": 0.11462276561713726, - "median_m": 0.11638049974670785, - "p90_m": 0.6517230395135248, - "p95_m": 1.210865366025621 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 96737.16299721874, - 162610.0927309627, - 190431.88317359178, - 529282.7623180376, - 791892.8412374883, - 944089.0903018916 - ], - "effective_rank": 6, - "scaled_condition_number": 9.759321661407776, - "weakest_scaled_direction": [ - 0.2441706927299802, - 0.9602157593336332, - 0.014180686947731067, - -0.12929711377254885, - 0.001880332584737895, - 0.03799996284532291 - ] - }, - "forward_reverse": { - "translation_m": 0.003676908482849856, - "rotation_deg": 0.03455537183665902 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.2587378679787436e-15, - "rotation_deg": 1.832521574973854e-14 - }, - { - "translation_m": 3.405182206613905e-15, - "rotation_deg": 1.9263324707288285e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 14288, - "frame_counter_j": 15761, - "rtk_translation_m": 3.933985934417215, - "rtk_rotation_deg": 80.31739505417984, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.17433313879018336, - 0.9846576725072801, - -0.0075647003978484536, - 2.158481899696832 - ], - [ - -0.9829774024435192, - 0.1735729128490779, - -0.060231803978295306, - -3.588729462494236 - ], - [ - -0.057994680833297806, - 0.017936328989871783, - 0.9981557519232213, - -0.003959482536303557 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6960, - "backend_objective": 568.2084337728777, - "backend_elapsed_sec": 0.2961113000055775, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3664, - "objective": 1188.626559403166 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 5600, - "objective": 768.2176232624398 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6960, - "objective": 568.2084337728777 - } - ], - "heldout_symmetric": { - "evaluated": 7884, - "inliers": 5091, - "inlier_ratio": 0.645738203957382, - "inlier_rmse_m": 0.11467441399973681, - "median_m": 0.1424969488981438, - "p90_m": 1.1563110283160816, - "p95_m": 1.6860533643071316 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 23477.999398523185, - 67432.60435223405, - 111974.20719092335, - 224362.4931759635, - 649756.4959692091, - 702814.5574757532 - ], - "effective_rank": 6, - "scaled_condition_number": 29.93502749301381, - "weakest_scaled_direction": [ - 0.03569074629600905, - 0.6540375458939782, - -0.002276503189076741, - -0.01612970227444498, - 0.005582808503203056, - -0.7554234188035219 - ] - }, - "forward_reverse": { - "translation_m": 0.002658154417044598, - "rotation_deg": 0.03997293849541112 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.7039753472859274e-15, - "rotation_deg": 9.028376365212535e-15 - }, - { - "translation_m": 2.199705978597706e-15, - "rotation_deg": 1.0576740161774684e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 20, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 14288, - "frame_counter_j": 16475, - "rtk_translation_m": 4.2254212089887, - "rtk_rotation_deg": 152.98392843416656, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8869973550800798, - 0.45975890230703426, - -0.04309807223500989, - -5.8560656703750675 - ], - [ - -0.4585108341705753, - -0.8879608049383231, - -0.03596420222233985, - -3.0970809320084833 - ], - [ - -0.054804261049180514, - -0.01213921919716247, - 0.9984233232092168, - -0.2329802954475424 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6743, - "backend_objective": 630.7807590489808, - "backend_elapsed_sec": 0.31770300000789575, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 27, - "num_inliers": 3814, - "objective": 980.2204783566035 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5796, - "objective": 601.1886655813404 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6743, - "objective": 630.7807590489808 - } - ], - "heldout_symmetric": { - "evaluated": 7713, - "inliers": 4652, - "inlier_ratio": 0.6031375599636977, - "inlier_rmse_m": 0.12542519992547976, - "median_m": 0.17369890124477222, - "p90_m": 1.3877890152054178, - "p95_m": 2.1095538861223706 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 22030.239685809873, - 26229.146719298635, - 66937.17777341149, - 262446.80811170733, - 504101.36223162885, - 610427.3912107134 - ], - "effective_rank": 6, - "scaled_condition_number": 27.708613247812377, - "weakest_scaled_direction": [ - -0.568622896024287, - 0.37650276530424115, - -0.015065236395297448, - -0.06793616776914607, - -0.03526809952239235, - -0.7272052989029216 - ] - }, - "forward_reverse": { - "translation_m": 4.543486491493239, - "rotation_deg": 1.5708713272202308 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 1.1041175742106086e-13, - "rotation_deg": 7.327186306207946e-13 - }, - { - "translation_m": 3.5629109797698155, - "rotation_deg": 0.7266053758533794 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 17, - "j": 21, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 14288, - "frame_counter_j": 17193, - "rtk_translation_m": 9.21529677253323, - "rtk_rotation_deg": 156.40620582407942, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9151318253834027, - -0.3995264803035694, - -0.05396604216247167, - -11.308982310340763 - ], - [ - 0.40100232961028565, - -0.9158678003722953, - -0.019578148235549323, - -2.1111386203048705 - ], - [ - -0.04160377167473093, - -0.03955709515942306, - 0.9983508213073148, - -0.28945080053379657 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 5521, - "backend_objective": 412.39735088646603, - "backend_elapsed_sec": 0.5441636999894399, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 3758, - "objective": 1410.90156779346 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 13, - "num_inliers": 5250, - "objective": 552.8338948409191 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 5521, - "objective": 412.39735088646603 - } - ], - "heldout_symmetric": { - "evaluated": 7951, - "inliers": 3715, - "inlier_ratio": 0.4672368255565338, - "inlier_rmse_m": 0.13751533766984328, - "median_m": 0.2863154262775397, - "p90_m": 1.989361641345888, - "p95_m": 2.71513748136762 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15519.484227508612, - 21750.496583081116, - 36296.8425998792, - 108337.58185766022, - 268548.4717962843, - 499685.5087396779 - ], - "effective_rank": 6, - "scaled_condition_number": 32.19730123852794, - "weakest_scaled_direction": [ - 0.7355741974444044, - 0.30989265236888863, - 0.0089945150864042, - 0.2032295736860753, - 0.19849117610835296, - 0.5311452119210485 - ] - }, - "forward_reverse": { - "translation_m": 0.13403735422224766, - "rotation_deg": 1.1805230479043929 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 3.7176907667312227, - "rotation_deg": 2.8903628220292714 - }, - { - "translation_m": 3.919323152907419e-14, - "rotation_deg": 6.28433014295275e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 17, - "j": 22, - "lidar_time_i": 1784785215.9006598, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 14288, - "frame_counter_j": 18005, - "rtk_translation_m": 11.781237287606983, - "rtk_rotation_deg": 150.82966218116434, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8701350250990675, - -0.49013823166962983, - -0.05127915708759895, - -13.99322835862824 - ], - [ - 0.4912419575208388, - -0.8709550715863977, - -0.010890475151596912, - -1.2970885678492468 - ], - [ - -0.03932400369927414, - -0.03466665737710628, - 0.9986249774561812, - -0.36101056978091484 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 5105, - "backend_objective": 349.5813579032026, - "backend_elapsed_sec": 0.3263374999805819, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 21, - "num_inliers": 3684, - "objective": 1155.3356770548876 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 5097, - "objective": 701.6824075488568 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 5105, - "objective": 349.5813579032026 - } - ], - "heldout_symmetric": { - "evaluated": 8064, - "inliers": 3432, - "inlier_ratio": 0.4255952380952381, - "inlier_rmse_m": 0.1417851723285674, - "median_m": 0.3390866943734385, - "p90_m": 2.5694914759158456, - "p95_m": 3.9910709733047884 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 14048.172337682869, - 15598.961862664391, - 22489.957863774205, - 37693.657216505664, - 188687.10583927447, - 543826.5459211724 - ], - "effective_rank": 6, - "scaled_condition_number": 38.71155142811069, - "weakest_scaled_direction": [ - 0.4427333807811441, - -0.25130733404807826, - 0.019336061627937585, - 0.21434114242231578, - 0.20402480365691325, - 0.8080158713010044 - ] - }, - "forward_reverse": { - "translation_m": 0.01638337185583796, - "rotation_deg": 0.14112774930143776 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.5176617391872307e-15, - "rotation_deg": 5.359716204636941e-15 - }, - { - "translation_m": 2.124706989126661e-15, - "rotation_deg": 1.0397409141450136e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 19, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785363.1952267, - "frame_counter_i": 15094, - "frame_counter_j": 15761, - "rtk_translation_m": 2.4460967931915643, - "rtk_rotation_deg": 52.425986732818345, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6166688866180832, - 0.7870446185827106, - 0.01674074780914908, - 1.1454955481033229 - ], - [ - -0.7858715871994714, - 0.6167166851253691, - -0.0454574385613675, - -2.8705686978806395 - ], - [ - -0.04610133088965668, - 0.014876109974466376, - 0.9988259951774527, - -0.04184207404053203 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7415, - "backend_objective": 799.4553602033754, - "backend_elapsed_sec": 0.21126290000393055, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3802, - "objective": 1034.3148554981492 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5965, - "objective": 622.4256041837552 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7415, - "objective": 799.4553602033754 - } - ], - "heldout_symmetric": { - "evaluated": 7615, - "inliers": 5330, - "inlier_ratio": 0.6999343401181878, - "inlier_rmse_m": 0.10876407223187468, - "median_m": 0.11703481718257248, - "p90_m": 0.9369166823507337, - "p95_m": 1.488940077417306 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 27806.40747883796, - 63162.65728278912, - 127946.39824729276, - 337060.43119514745, - 672163.7730502074, - 1026587.6212202314 - ], - "effective_rank": 6, - "scaled_condition_number": 36.919102980185954, - "weakest_scaled_direction": [ - 0.06751866246552198, - -0.6961557436422777, - 0.002943196657429115, - 0.01995829931269076, - 0.004154402336585817, - 0.7144117549676384 - ] - }, - "forward_reverse": { - "translation_m": 0.0029722527816906422, - "rotation_deg": 0.028553700929610463 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8209011484034673e-15, - "rotation_deg": 1.6226628286617997e-15 - }, - { - "translation_m": 4.074519445727608e-15, - "rotation_deg": 7.471594471095906e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 20, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 15094, - "frame_counter_j": 16475, - "rtk_translation_m": 6.593931011285688, - "rtk_rotation_deg": 125.09252011280485, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5665450812951606, - 0.8237522552072852, - -0.02142178566720975, - -6.155007566423961 - ], - [ - -0.8224464628865413, - -0.5668759885765905, - -0.047259171181158625, - -6.207814488981458 - ], - [ - -0.051073344766881905, - -0.009156179128061163, - 0.9986529316224421, - -0.23463190286292565 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6120, - "backend_objective": 550.8066595708967, - "backend_elapsed_sec": 0.24520800000755116, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 13, - "num_inliers": 3725, - "objective": 1212.0411610575825 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5461, - "objective": 567.7029098951957 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6120, - "objective": 550.8066595708967 - } - ], - "heldout_symmetric": { - "evaluated": 7444, - "inliers": 4315, - "inlier_ratio": 0.5796614723267061, - "inlier_rmse_m": 0.12778176089815, - "median_m": 0.1858521954540106, - "p90_m": 1.566677341196506, - "p95_m": 2.3871834573107855 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 16318.001547284653, - 23145.929877441456, - 53033.59884601272, - 199909.77739597834, - 362669.24723638385, - 529692.1337787998 - ], - "effective_rank": 6, - "scaled_condition_number": 32.46060078153023, - "weakest_scaled_direction": [ - 0.9897729590346724, - -0.10339858328094514, - 0.03434421736284127, - 0.017559966896857158, - 0.07161301626330527, - 0.055153610373471065 - ] - }, - "forward_reverse": { - "translation_m": 0.0849644734357879, - "rotation_deg": 0.24110896992060843 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.041286520114393e-15, - "rotation_deg": 5.288948761910844e-15 - }, - { - "translation_m": 2.6929057097562602e-11, - "rotation_deg": 3.7322772955810407e-10 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 18, - "j": 21, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 15094, - "frame_counter_j": 17193, - "rtk_translation_m": 11.793089868757727, - "rtk_rotation_deg": 175.70238585456048, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9961177296562256, - 0.0785002189081896, - -0.039839481621793654, - -11.443770192304987 - ], - [ - -0.07723563659408468, - -0.9964879577117396, - -0.0323482082253917, - -7.918746736866754 - ], - [ - -0.04223890510457652, - -0.029145596011286475, - 0.9986823364457358, - -0.28275947355445386 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 4812, - "backend_objective": 303.5010508955818, - "backend_elapsed_sec": 0.3329832000017632, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3582, - "objective": 1112.007109025967 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 4890, - "objective": 587.7227975932129 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 4812, - "objective": 303.5010508955818 - } - ], - "heldout_symmetric": { - "evaluated": 7682, - "inliers": 3253, - "inlier_ratio": 0.42345743296016664, - "inlier_rmse_m": 0.14463219993853524, - "median_m": 0.33236555424021896, - "p90_m": 1.9556612977696193, - "p95_m": 3.111894915346001 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 10554.468165159922, - 12367.895205400244, - 36653.41374055748, - 82348.74780435071, - 230599.68720145605, - 439885.3584055563 - ], - "effective_rank": 6, - "scaled_condition_number": 41.677643204951686, - "weakest_scaled_direction": [ - -0.5380529269838565, - -0.6726144877068561, - -0.02253687127809677, - 0.04962128492547805, - -0.04536400214628976, - 0.5030514123979367 - ] - }, - "forward_reverse": { - "translation_m": 0.008594432490503082, - "rotation_deg": 0.044791316017877565 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.094764613337708e-15, - "rotation_deg": 1.0850074083207034e-14 - }, - { - "translation_m": 2.5219419200973697e-15, - "rotation_deg": 3.567475227851567e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 22, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 15094, - "frame_counter_j": 18005, - "rtk_translation_m": 14.40479158879449, - "rtk_rotation_deg": 178.72107050256645, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9985448119288007, - -0.02217005479007189, - -0.049160423520143985, - -14.18395117061842 - ], - [ - 0.022748053897618154, - -0.9996781639247944, - -0.0112291858931195, - -8.473655911181039 - ], - [ - -0.04889565025588451, - -0.012331149279624516, - 0.9987277697868918, - -0.45196697392102686 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 14, - "backend_num_inliers": 4248, - "backend_objective": 261.62895305298275, - "backend_elapsed_sec": 0.40820580002036877, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 20, - "num_inliers": 3515, - "objective": 1142.1154564057774 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 10, - "num_inliers": 4552, - "objective": 557.5256266392594 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 14, - "num_inliers": 4248, - "objective": 261.62895305298275 - } - ], - "heldout_symmetric": { - "evaluated": 7795, - "inliers": 2774, - "inlier_ratio": 0.35586914688903143, - "inlier_rmse_m": 0.14801012931814386, - "median_m": 0.4291732063241244, - "p90_m": 2.883860679836218, - "p95_m": 5.831619224817732 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 3825.3604013611125, - 8017.646726456478, - 18185.60160817907, - 21361.11637166481, - 165888.14582796325, - 454524.0934099317 - ], - "effective_rank": 6, - "scaled_condition_number": 118.81863294454718, - "weakest_scaled_direction": [ - 0.2827821147678944, - -0.6470253074097836, - 0.017550741587884274, - 0.06502437057249673, - 0.0529843601183894, - 0.7028861838326909 - ] - }, - "forward_reverse": { - "translation_m": 0.05364920712348454, - "rotation_deg": 0.15560820359743163 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.4273359795629357e-15, - "rotation_deg": 2.4002476230081362e-14 - }, - { - "translation_m": 1.1102230246251565e-16, - "rotation_deg": 1.0995617218356242e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 18, - "j": 23, - "lidar_time_i": 1784785296.4990919, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 15094, - "frame_counter_j": 18949, - "rtk_translation_m": 11.744734461596845, - "rtk_rotation_deg": 164.11569663484164, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9611999073835812, - -0.27111190076755987, - -0.05092224767227162, - -10.437033352185441 - ], - [ - 0.27281571676242383, - -0.9615969895960386, - -0.030046868176919674, - -8.345739046028372 - ], - [ - -0.040820616521563276, - -0.04277343640668627, - 0.9982505248707674, - -0.35411708595409863 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 4613, - "backend_objective": 310.71837780126924, - "backend_elapsed_sec": 0.3484112999867648, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3511, - "objective": 1040.5534591113503 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 4771, - "objective": 509.6926430777731 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 4613, - "objective": 310.71837780126924 - } - ], - "heldout_symmetric": { - "evaluated": 7640, - "inliers": 3031, - "inlier_ratio": 0.3967277486910995, - "inlier_rmse_m": 0.14073241205403209, - "median_m": 0.35988623853274004, - "p90_m": 2.248437852410559, - "p95_m": 3.1450616113852243 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 6572.262342046283, - 9565.160177215175, - 29583.698664866857, - 114171.3232614246, - 211996.89197156896, - 445702.64726451575 - ], - "effective_rank": 6, - "scaled_condition_number": 67.8157115569044, - "weakest_scaled_direction": [ - 0.001952230904167986, - -0.6289463080696699, - -0.030064534159027205, - 0.08347421334419525, - 0.05857579976379546, - 0.7701427046557209 - ] - }, - "forward_reverse": { - "translation_m": 0.0379980141073483, - "rotation_deg": 0.09667096210106078 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.925929145204076e-15, - "rotation_deg": 2.0315620965726475e-14 - }, - { - "translation_m": 2.9546328455357126e-15, - "rotation_deg": 1.0144710744580045e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 20, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785434.592462, - "frame_counter_i": 15761, - "frame_counter_j": 16475, - "rtk_translation_m": 6.650720121741557, - "rtk_rotation_deg": 72.6665333799865, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.2995923077860652, - 0.9535876114371953, - -0.030250891374051663, - -1.8692525432729097 - ], - [ - -0.9538656422857977, - 0.2987264613179423, - -0.03004725902910414, - -7.805629127268184 - ], - [ - -0.019615952235914183, - 0.037857213605402694, - 0.9990906094023274, - -0.1319386642456338 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6489, - "backend_objective": 569.4999740060804, - "backend_elapsed_sec": 0.23349149999557994, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3924, - "objective": 1013.1238717514323 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5901, - "objective": 609.5218769434994 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6489, - "objective": 569.4999740060804 - } - ], - "heldout_symmetric": { - "evaluated": 7779, - "inliers": 4870, - "inlier_ratio": 0.6260444787247719, - "inlier_rmse_m": 0.12668491637849374, - "median_m": 0.16690116061994517, - "p90_m": 0.9919220276627585, - "p95_m": 1.6480707039030054 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18712.055963797415, - 62228.326497031216, - 77714.40815168971, - 214006.9347111848, - 394739.3877876983, - 486135.873697716 - ], - "effective_rank": 6, - "scaled_condition_number": 25.97982149253148, - "weakest_scaled_direction": [ - 0.7915814532828056, - -0.26319498492498683, - 0.03428877964504143, - -0.009154876029483082, - 0.06927540668896554, - 0.545956581233741 - ] - }, - "forward_reverse": { - "translation_m": 0.022781715838261912, - "rotation_deg": 0.19834674514582162 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.4875916307951376e-12, - "rotation_deg": 2.2492564362621704e-11 - }, - { - "translation_m": 1.4879061046170573e-12, - "rotation_deg": 2.2490123134142957e-11 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 21, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 15761, - "frame_counter_j": 17193, - "rtk_translation_m": 12.053580264031138, - "rtk_rotation_deg": 123.27639912174077, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.5506805388687266, - 0.8328007923203508, - -0.0565135773230177, - -3.7747388734195635 - ], - [ - -0.83236569739092, - -0.5529471237507978, - -0.037640724523414125, - -13.014171294621576 - ], - [ - -0.06259624524024228, - 0.026311948736566334, - 0.9976920323604409, - -0.23227395154899766 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 4457, - "backend_objective": 279.6845936317817, - "backend_elapsed_sec": 0.3453620000218507, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 3677, - "objective": 1198.257620374833 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4844, - "objective": 692.5596682301618 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 4457, - "objective": 279.6845936317817 - } - ], - "heldout_symmetric": { - "evaluated": 8017, - "inliers": 3169, - "inlier_ratio": 0.3952850193339154, - "inlier_rmse_m": 0.1421446220617431, - "median_m": 0.3734448025882331, - "p90_m": 1.8906380817841777, - "p95_m": 2.796117220715787 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 5961.432446850127, - 7392.873845035771, - 36921.54359593741, - 57983.82739755071, - 231812.44608797968, - 366944.0849801991 - ], - "effective_rank": 6, - "scaled_condition_number": 61.553005632745744, - "weakest_scaled_direction": [ - 0.6544201355899028, - 0.6710714556634665, - 0.024834101230549098, - -0.015050640102952574, - 0.05417436451595685, - -0.34295666111924955 - ] - }, - "forward_reverse": { - "translation_m": 0.01796074748252817, - "rotation_deg": 0.16263425635632095 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.155133597044475e-16, - "rotation_deg": 1.508692995972905e-14 - }, - { - "translation_m": 1.0190492755571723e-15, - "rotation_deg": 8.464297521149338e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 22, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 15761, - "frame_counter_j": 18005, - "rtk_translation_m": 14.836246959975925, - "rtk_rotation_deg": 128.85294276465592, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6300543055212069, - 0.7726255258633034, - -0.07798313201355275, - -5.011518345998407 - ], - [ - -0.7728530103686385, - -0.6336728752027377, - -0.034013403187997525, - -15.51780072680438 - ], - [ - -0.07569541900486976, - 0.03883920721062266, - 0.9963742868645936, - -0.4688497170840485 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 10, - "backend_num_inliers": 3711, - "backend_objective": 230.81169182278836, - "backend_elapsed_sec": 0.2870293999731075, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 3512, - "objective": 1404.7905509820691 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 4328, - "objective": 610.2056432940487 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 10, - "num_inliers": 3711, - "objective": 230.81169182278836 - } - ], - "heldout_symmetric": { - "evaluated": 8130, - "inliers": 2632, - "inlier_ratio": 0.3237392373923739, - "inlier_rmse_m": 0.15069330869045588, - "median_m": 0.4880827578091864, - "p90_m": 2.409953622425376, - "p95_m": 4.2140066762316835 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 4348.489322610439, - 7293.397334272058, - 16095.643565138025, - 19392.35856061217, - 129209.23229107982, - 329202.6037022384 - ], - "effective_rank": 6, - "scaled_condition_number": 75.70505048512227, - "weakest_scaled_direction": [ - -0.31482124557625646, - 0.552278987893098, - -0.020435105741246334, - -0.10511361044350188, - -0.10096259062519468, - -0.7577701455670542 - ] - }, - "forward_reverse": { - "translation_m": 0.2579934626807855, - "rotation_deg": 1.1847082611411373 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.7012244807939757e-14, - "rotation_deg": 1.3759039323068125e-13 - }, - { - "translation_m": 2.8268641583721086e-14, - "rotation_deg": 9.032318668758963e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 19, - "j": 23, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 15761, - "frame_counter_j": 18949, - "rtk_translation_m": 11.740810561661805, - "rtk_rotation_deg": 143.45831663234065, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8041368954414141, - 0.5908300063778916, - -0.06545041599062035, - -2.8143887657091415 - ], - [ - -0.5894167084970622, - -0.8067777007499145, - -0.04120297704256744, - -12.499189000825016 - ], - [ - -0.07714789131488636, - 0.005444734721000917, - 0.9970047932329532, - -0.21876169270707282 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 4562, - "backend_objective": 247.01928672257793, - "backend_elapsed_sec": 0.22123629998532124, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 12, - "num_inliers": 3594, - "objective": 1044.6290847344687 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 4734, - "objective": 643.1780536798803 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 4562, - "objective": 247.01928672257793 - } - ], - "heldout_symmetric": { - "evaluated": 7975, - "inliers": 3012, - "inlier_ratio": 0.37768025078369905, - "inlier_rmse_m": 0.1432975121556299, - "median_m": 0.3957613098519592, - "p90_m": 2.0120282675938332, - "p95_m": 2.8069058800432365 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 8948.659512505583, - 12776.907093470927, - 38534.553728192295, - 77386.50643427821, - 239329.48071703356, - 348416.52438594337 - ], - "effective_rank": 6, - "scaled_condition_number": 38.93505210462392, - "weakest_scaled_direction": [ - 0.5476120626836286, - 0.7713750454006084, - 0.021983266633209132, - -0.009106692833661608, - 0.0939585253531646, - 0.3093657508254854 - ] - }, - "forward_reverse": { - "translation_m": 0.07411982241929344, - "rotation_deg": 0.4458370864472602 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.965351675814767e-15, - "rotation_deg": 5.322498974963192e-15 - }, - { - "translation_m": 2.6296119242823513e-15, - "rotation_deg": 2.6416453477886153e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 19, - "j": 24, - "lidar_time_i": 1784785363.1952267, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 15761, - "frame_counter_j": 20284, - "rtk_translation_m": 11.093516369446519, - "rtk_rotation_deg": 177.87107120383473, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9974791691815873, - 0.04249524157580704, - -0.056828351130612985, - -2.205717647384636 - ], - [ - -0.040733265709239935, - -0.9986634841878906, - -0.03181267694431082, - -11.137262226130922 - ], - [ - -0.05810428653267238, - -0.029417678241432176, - 0.9978769924662122, - -0.2111400023477513 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 15, - "backend_num_inliers": 4985, - "backend_objective": 346.50606556509143, - "backend_elapsed_sec": 0.3630827000015415, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3492, - "objective": 929.9849476190784 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4872, - "objective": 629.1355433019529 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 15, - "num_inliers": 4985, - "objective": 346.50606556509143 - } - ], - "heldout_symmetric": { - "evaluated": 7875, - "inliers": 3426, - "inlier_ratio": 0.43504761904761907, - "inlier_rmse_m": 0.13924446561169374, - "median_m": 0.3216392154668307, - "p90_m": 1.6412986649403454, - "p95_m": 2.578177518818419 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 8616.426171309877, - 22139.86015376056, - 45947.311781646065, - 57613.47300891338, - 275544.0074778941, - 361343.67000271933 - ], - "effective_rank": 6, - "scaled_condition_number": 41.93660606132572, - "weakest_scaled_direction": [ - 0.07175289648514459, - 0.9749666186854877, - 0.03312925170474936, - -0.0668038916444731, - 0.06827920222720169, - 0.18457859459003498 - ] - }, - "forward_reverse": { - "translation_m": 0.04258350776081339, - "rotation_deg": 0.7879276702809055 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 1.8610729195778454e-15, - "rotation_deg": 1.703632180535041e-15 - }, - { - "translation_m": 0.44098324221774876, - "rotation_deg": 5.762337921680544 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 20, - "j": 21, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785506.389296, - "frame_counter_i": 16475, - "frame_counter_j": 17193, - "rtk_translation_m": 5.40286046809103, - "rtk_rotation_deg": 50.60986574175429, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6301981813065091, - 0.7764268692428195, - 0.003401322648986552, - 4.39863388696172 - ], - [ - -0.7761873138414891, - 0.6301021429851937, - -0.02246203991182845, - -3.38202078990369 - ], - [ - -0.019583312015658712, - 0.01151547321044341, - 0.9997419105785438, - 0.08505435361015698 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7432, - "backend_objective": 841.7889014088194, - "backend_elapsed_sec": 0.2433473999844864, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4419, - "objective": 1021.5747377426837 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6575, - "objective": 678.6038158007818 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7432, - "objective": 841.7889014088194 - } - ], - "heldout_symmetric": { - "evaluated": 7846, - "inliers": 5184, - "inlier_ratio": 0.6607188376242672, - "inlier_rmse_m": 0.12214671257866079, - "median_m": 0.15023898240221245, - "p90_m": 0.9374078882444975, - "p95_m": 1.4616253051790022 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 44340.727888143774, - 50672.870391665434, - 118270.52282821866, - 293841.55674556154, - 476187.42673343327, - 624441.520520691 - ], - "effective_rank": 6, - "scaled_condition_number": 14.082798146569438, - "weakest_scaled_direction": [ - 0.17746322243169121, - 0.03155905325372502, - -0.011873699009488163, - 0.8336479203850031, - 0.5022823792752309, - 0.14182172760579959 - ] - }, - "forward_reverse": { - "translation_m": 0.01471691635641488, - "rotation_deg": 0.0747935794181239 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.534554168259711e-06, - "rotation_deg": 4.5311436364444247e-05 - }, - { - "translation_m": 5.534554168333668e-06, - "rotation_deg": 4.531143636222666e-05 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 22, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 16475, - "frame_counter_j": 18005, - "rtk_translation_m": 8.200956565000565, - "rtk_rotation_deg": 56.18640938466938, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5496172539019083, - 0.835387051591116, - -0.007024830761537297, - 6.450441857741791 - ], - [ - -0.8351490077183537, - 0.5492089812922016, - -0.029927074281191027, - -5.343962062450511 - ], - [ - -0.021142590200218452, - 0.022315216823633896, - 0.9995273993131655, - 0.11285970042172674 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 6757, - "backend_objective": 573.3125481864666, - "backend_elapsed_sec": 0.22552869998617098, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4312, - "objective": 1004.7367361664083 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6214, - "objective": 734.9190580921559 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 6757, - "objective": 573.3125481864666 - } - ], - "heldout_symmetric": { - "evaluated": 7959, - "inliers": 4587, - "inlier_ratio": 0.576328684508104, - "inlier_rmse_m": 0.13245799460807672, - "median_m": 0.19975022791929564, - "p90_m": 1.1478644508327356, - "p95_m": 1.6805524465089412 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34413.76904378472, - 35089.02863964063, - 67064.133147841, - 142382.57268090028, - 410896.55246784317, - 551790.7600769354 - ], - "effective_rank": 6, - "scaled_condition_number": 16.034011252149995, - "weakest_scaled_direction": [ - -0.5413592306245072, - -0.2686398625801602, - -0.0202596609897498, - -0.605727566710206, - -0.5106932382176763, - -0.08147935415312677 - ] - }, - "forward_reverse": { - "translation_m": 0.02165175771302933, - "rotation_deg": 0.4612076789897289 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.713178136967715e-15, - "rotation_deg": 1.5032960692226754e-13 - }, - { - "translation_m": 1.7684718691806487e-07, - "rotation_deg": 2.614237323819308e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 23, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 16475, - "frame_counter_j": 18949, - "rtk_translation_m": 5.175118275082073, - "rtk_rotation_deg": 70.79178325235415, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.32256721290178414, - 0.9465460797646612, - 0.0009550093859780853, - 4.208259377594814 - ], - [ - -0.945994895560604, - 0.32241349198423586, - -0.033811207606571476, - -2.3193859738621594 - ], - [ - -0.032311773923120214, - 0.010002952998147617, - 0.9994277813815551, - 0.10775047283783244 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 7359, - "backend_objective": 845.5633979281702, - "backend_elapsed_sec": 0.23695839999709278, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4338, - "objective": 911.2596131666338 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6516, - "objective": 691.1437643500954 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 7359, - "objective": 845.5633979281702 - } - ], - "heldout_symmetric": { - "evaluated": 7804, - "inliers": 5035, - "inlier_ratio": 0.6451819579702717, - "inlier_rmse_m": 0.12102263178677423, - "median_m": 0.1559895039044221, - "p90_m": 0.9688366245734089, - "p95_m": 1.49426709179214 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 53027.85303585267, - 56080.75777160752, - 143070.11462165575, - 383136.57859657257, - 443255.2922774473, - 663456.339188899 - ], - "effective_rank": 6, - "scaled_condition_number": 12.511468996120387, - "weakest_scaled_direction": [ - -0.3103954872435256, - -0.24401868710361824, - 0.012355200029402224, - -0.5414145041653489, - -0.7117003300369048, - -0.21049903985544594 - ] - }, - "forward_reverse": { - "translation_m": 0.018249896901851893, - "rotation_deg": 0.12115759970382113 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.662158620367905e-15, - "rotation_deg": 2.3042195393728068e-14 - }, - { - "translation_m": 1.8563065093075665e-15, - "rotation_deg": 1.2622973743528364e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 24, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 16475, - "frame_counter_j": 20284, - "rtk_translation_m": 4.710308396362637, - "rtk_rotation_deg": 105.20453782384023, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.2589411585105461, - 0.9658790687160898, - -0.00520586643649611, - 3.08192906684004 - ], - [ - -0.9657761472795204, - -0.2589899145061792, - -0.014165363744281992, - -1.3317978172202731 - ], - [ - -0.01503029524467048, - 0.001359705931623316, - 0.9998861142273341, - 0.05855535952942754 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7947, - "backend_objective": 828.765715422846, - "backend_elapsed_sec": 0.24634510002215393, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4198, - "objective": 1453.863410541216 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6665, - "objective": 955.5540696139832 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7947, - "objective": 828.765715422846 - } - ], - "heldout_symmetric": { - "evaluated": 7704, - "inliers": 5688, - "inlier_ratio": 0.7383177570093458, - "inlier_rmse_m": 0.11441422046802802, - "median_m": 0.1206966324210205, - "p90_m": 0.6821797692450176, - "p95_m": 1.129705958523537 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 62496.01731270753, - 70194.43621434887, - 183680.88832673497, - 374325.9260408858, - 609173.5954095792, - 759497.7110346676 - ], - "effective_rank": 6, - "scaled_condition_number": 12.152737785424229, - "weakest_scaled_direction": [ - 0.21789141672528795, - 0.7454163621037097, - -0.0009605891814390714, - -0.031064774376616564, - 0.40307076050369756, - 0.48316228817431883 - ] - }, - "forward_reverse": { - "translation_m": 0.009011279667019194, - "rotation_deg": 0.06430292411421322 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.943432665244099e-15, - "rotation_deg": 1.4991032967055917e-14 - }, - { - "translation_m": 1.996087139617986e-15, - "rotation_deg": 3.4847052261658093e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 25, - "lidar_time_i": 1784785434.592462, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 16475, - "frame_counter_j": 21049, - "rtk_translation_m": 8.226491803107123, - "rtk_rotation_deg": 68.57831319871164, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.36472487616827326, - 0.9310705876163026, - 0.009128284607280327, - 4.718091568740359 - ], - [ - -0.9306796876858751, - 0.36423685356907465, - 0.03415894364618221, - -7.302169850498349 - ], - [ - 0.028479530069164212, - -0.020954125558804243, - 0.9993747250101462, - 0.1831713409168159 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7051, - "backend_objective": 481.92528333929243, - "backend_elapsed_sec": 0.2588349000143353, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4061, - "objective": 790.7661291518403 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6106, - "objective": 628.5696545826204 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7051, - "objective": 481.92528333929243 - } - ], - "heldout_symmetric": { - "evaluated": 7964, - "inliers": 4924, - "inlier_ratio": 0.6182822702159718, - "inlier_rmse_m": 0.12791257682460647, - "median_m": 0.1698836970918688, - "p90_m": 1.1685966238925811, - "p95_m": 1.8448430432547474 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20350.618460298832, - 37569.96463500192, - 48033.61600525111, - 108559.9013833798, - 526742.970578636, - 592287.6851074039 - ], - "effective_rank": 6, - "scaled_condition_number": 29.104161441720954, - "weakest_scaled_direction": [ - -0.42556444577949426, - -0.569911161738633, - -0.017271094605284174, - 0.09315786156407158, - -0.04019256455762905, - 0.6953445549426117 - ] - }, - "forward_reverse": { - "translation_m": 0.014703530260578728, - "rotation_deg": 0.32055535743282454 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.40619762898109e-16, - "rotation_deg": 4.5170095684232995e-15 - }, - { - "translation_m": 3.591668609095541e-15, - "rotation_deg": 2.3570729087321212e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 22, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785587.5863533, - "frame_counter_i": 17193, - "frame_counter_j": 18005, - "rtk_translation_m": 2.8644847627909416, - "rtk_rotation_deg": 5.57654364291509, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9949871489467763, - 0.10000253475913753, - 0.00025782263898075465, - 2.814440047729085 - ], - [ - -0.09999491339360277, - 0.9949372219711345, - -0.010046971273306804, - 0.35486864144369806 - ], - [ - -0.0012612399341716996, - 0.009970826350321912, - 0.9999494946724657, - 0.09487990842832685 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9146, - "backend_objective": 1703.409723975221, - "backend_elapsed_sec": 0.24805360002210364, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4644, - "objective": 868.2820515524207 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7403, - "objective": 778.2783448452358 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9146, - "objective": 1703.409723975221 - } - ], - "heldout_symmetric": { - "evaluated": 8197, - "inliers": 6345, - "inlier_ratio": 0.7740636818348177, - "inlier_rmse_m": 0.11564788773425824, - "median_m": 0.11881922766695734, - "p90_m": 0.5710791007457086, - "p95_m": 0.9594951467730475 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68955.61191477656, - 276543.8285017942, - 369434.1645927724, - 415426.7061479706, - 561199.6486688191, - 841918.661083003 - ], - "effective_rank": 6, - "scaled_condition_number": 12.209574213097333, - "weakest_scaled_direction": [ - -0.06746522435169258, - 0.05416703526780531, - -0.032449063001995834, - -0.804900283074206, - -0.5853715569081089, - -0.03061223242111958 - ] - }, - "forward_reverse": { - "translation_m": 0.0065184199045192235, - "rotation_deg": 0.06991965908247275 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.516639917446636e-14, - "rotation_deg": 4.623659557428911e-13 - }, - { - "translation_m": 1.787650848661936e-15, - "rotation_deg": 1.4331825293103942e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 17193, - "frame_counter_j": 18949, - "rtk_translation_m": 1.2936223973175418, - "rtk_rotation_deg": 20.18191751059984, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9381685004700115, - 0.34605724063899157, - 0.009178830381697225, - -0.9318953948390342 - ], - [ - -0.34596327975609076, - 0.9381901784637574, - -0.01042104095341573, - 0.5294051243001446 - ], - [ - -0.012217765190818047, - 0.006601154101425794, - 0.9999035708398443, - -0.002502879994889205 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 10022, - "backend_objective": 1419.0499751223717, - "backend_elapsed_sec": 0.2134786999959033, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4616, - "objective": 750.6539590039605 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7746, - "objective": 821.9219639122146 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 10022, - "objective": 1419.0499751223717 - } - ], - "heldout_symmetric": { - "evaluated": 8042, - "inliers": 6934, - "inlier_ratio": 0.862223327530465, - "inlier_rmse_m": 0.10307116830776755, - "median_m": 0.08939175565884207, - "p90_m": 0.3514120568530705, - "p95_m": 0.7088981381611085 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 102715.79092682658, - 307631.7472744465, - 574725.5516161988, - 712149.1897057669, - 831554.8125380467, - 1142661.736879501 - ], - "effective_rank": 6, - "scaled_condition_number": 11.124499228103288, - "weakest_scaled_direction": [ - -0.060378503544198714, - 0.025478424004135802, - 0.012984605396990187, - -0.6274958356377294, - -0.7743238586147251, - -0.04699174906325607 - ] - }, - "forward_reverse": { - "translation_m": 0.0026785916987678697, - "rotation_deg": 0.01879221122979615 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.3452156777087964e-06, - "rotation_deg": 5.457411412584476e-06 - }, - { - "translation_m": 2.5383669873575945e-15, - "rotation_deg": 1.6919296846028982e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 17193, - "frame_counter_j": 20284, - "rtk_translation_m": 2.3128500583741403, - "rtk_rotation_deg": 54.59467208208593, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5864769751762654, - 0.8099460332920043, - -0.005672807298438478, - -2.4096154798797964 - ], - [ - -0.8099295559471344, - 0.5865026229977585, - 0.00536540958615149, - 0.2727395222292259 - ], - [ - 0.00767280857158529, - 0.0014478851115300648, - 0.9999695153540072, - -0.022944430739222105 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8464, - "backend_objective": 1162.7767389441092, - "backend_elapsed_sec": 0.27223569998750463, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4148, - "objective": 828.1952790032508 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6865, - "objective": 856.3185305879489 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8464, - "objective": 1162.7767389441092 - } - ], - "heldout_symmetric": { - "evaluated": 7942, - "inliers": 6191, - "inlier_ratio": 0.7795265676152102, - "inlier_rmse_m": 0.11182158240581822, - "median_m": 0.10716354058076344, - "p90_m": 0.5589406319578444, - "p95_m": 0.9607006134986359 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 56693.42014747004, - 124209.97002507027, - 247427.18293520404, - 438330.3972872241, - 546318.6584470777, - 903353.7178038924 - ], - "effective_rank": 6, - "scaled_condition_number": 15.934013426145448, - "weakest_scaled_direction": [ - 0.05656715636850258, - 0.023812998671804544, - -0.0002796892755809372, - 0.09536096170819146, - 0.9923286670814698, - 0.04922522888670723 - ] - }, - "forward_reverse": { - "translation_m": 0.003491995501356654, - "rotation_deg": 0.0374256510953578 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.0132990584074992e-15, - "rotation_deg": 1.693025760075907e-14 - }, - { - "translation_m": 9.332106938114179e-16, - "rotation_deg": 8.987715771713424e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 25, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 17193, - "frame_counter_j": 21049, - "rtk_translation_m": 3.793272903723766, - "rtk_rotation_deg": 17.968447456957346, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.951465406759142, - 0.30462790245371113, - -0.0437655205305701, - 3.246246284934705 - ], - [ - -0.3028280168284787, - 0.952061916961844, - 0.043281618438653205, - -2.2236041536135907 - ], - [ - 0.054852274012936325, - -0.02792753690518858, - 0.9981038426526663, - 0.23152263166160567 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8544, - "backend_objective": 1186.7914632066486, - "backend_elapsed_sec": 0.3494078000076115, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4390, - "objective": 755.102608609444 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6990, - "objective": 722.0196792328461 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8544, - "objective": 1186.7914632066486 - } - ], - "heldout_symmetric": { - "evaluated": 8202, - "inliers": 6021, - "inlier_ratio": 0.7340892465252378, - "inlier_rmse_m": 0.12002239056891174, - "median_m": 0.13187868486785037, - "p90_m": 0.8441743066590516, - "p95_m": 1.5635195490658773 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 45161.41165401633, - 88495.6665623439, - 230087.91200777455, - 375657.3807349393, - 498970.7377792786, - 748422.2743395879 - ], - "effective_rank": 6, - "scaled_condition_number": 16.57216298005221, - "weakest_scaled_direction": [ - -0.05711903308571431, - 0.09722996092931892, - -0.0006718660563098488, - -0.6676512451049326, - -0.7327792842646098, - -0.06752506805267046 - ] - }, - "forward_reverse": { - "translation_m": 0.037735058311297705, - "rotation_deg": 0.2878144229712423 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.4124810357301033e-15, - "rotation_deg": 1.5421625325312505e-14 - }, - { - "translation_m": 1.3666101008105044e-15, - "rotation_deg": 4.390810401501978e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 26, - "lidar_time_i": 1784785506.389296, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 17193, - "frame_counter_j": 21808, - "rtk_translation_m": 4.631707245574304, - "rtk_rotation_deg": 60.912845043424184, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.48806176319002476, - 0.8716863242937033, - -0.044256833948862984, - 3.8161629787833466 - ], - [ - -0.8709224865092036, - 0.4897124551924127, - 0.04093572671940675, - -2.3729744624638465 - ], - [ - 0.05735623596847181, - 0.018565108907630003, - 0.9981811453472647, - 0.26506900488783713 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8240, - "backend_objective": 1120.634646080745, - "backend_elapsed_sec": 0.27241249999497086, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3989, - "objective": 831.3073148022323 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6491, - "objective": 641.9008184249741 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8240, - "objective": 1120.634646080745 - } - ], - "heldout_symmetric": { - "evaluated": 8252, - "inliers": 5898, - "inlier_ratio": 0.7147358216190014, - "inlier_rmse_m": 0.11997311573294966, - "median_m": 0.13518689601537945, - "p90_m": 0.8557175690024953, - "p95_m": 1.67161649650294 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 41965.89761056792, - 47466.75249187217, - 201336.8816755612, - 390732.0326679377, - 517025.81420962076, - 729044.8199640175 - ], - "effective_rank": 6, - "scaled_condition_number": 17.372315653280065, - "weakest_scaled_direction": [ - 0.07669344992623661, - -0.37363991694573523, - 0.0056503294265457605, - 0.03227063945328418, - 0.8000863050351066, - 0.46184403352767633 - ] - }, - "forward_reverse": { - "translation_m": 0.012351932089198563, - "rotation_deg": 0.10379217190868555 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.341259198934301e-13, - "rotation_deg": 2.913456283126336e-13 - }, - { - "translation_m": 2.610684629078812e-15, - "rotation_deg": 3.4668416835300865e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785681.9825997, - "frame_counter_i": 18005, - "frame_counter_j": 18949, - "rtk_translation_m": 3.7194009250537223, - "rtk_rotation_deg": 14.605373867684753, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9680180899465552, - 0.25084012572879505, - 0.004495426630019777, - -3.74300761383286 - ], - [ - -0.25086900490704056, - 0.9679895115926125, - 0.007813310671311182, - -0.20412154694927875 - ], - [ - -0.002391633996843435, - -0.008691189277507354, - 0.9999593708325196, - -0.09262483651087947 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8546, - "backend_objective": 1321.8517754886582, - "backend_elapsed_sec": 0.2790126999898348, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4420, - "objective": 890.1276923712095 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7052, - "objective": 954.3336913888552 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8546, - "objective": 1321.8517754886582 - } - ], - "heldout_symmetric": { - "evaluated": 8155, - "inliers": 6042, - "inlier_ratio": 0.7408951563458002, - "inlier_rmse_m": 0.11726725109752717, - "median_m": 0.12207350159014241, - "p90_m": 0.6851390412082611, - "p95_m": 1.131610394473617 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 68439.22404216403, - 162544.12904499072, - 218614.58984913744, - 442226.72856045084, - 481438.1708275909, - 863033.2148717172 - ], - "effective_rank": 6, - "scaled_condition_number": 12.610213323576254, - "weakest_scaled_direction": [ - 0.06875318882715073, - -0.021343991953650457, - 0.016940565304647288, - 0.6313478605987582, - 0.7719555035339748, - 0.0038768236634954827 - ] - }, - "forward_reverse": { - "translation_m": 0.009206244303295173, - "rotation_deg": 0.09601986001481369 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 8.934752161915345e-16, - "rotation_deg": 6.411728736501268e-15 - }, - { - "translation_m": 9.884453757227279e-16, - "rotation_deg": 2.291306414268005e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 18005, - "frame_counter_j": 20284, - "rtk_translation_m": 4.786117710081478, - "rtk_rotation_deg": 49.01812843917083, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6643152165229396, - 0.7473343175313717, - -0.013293266566204139, - -5.200984531085628 - ], - [ - -0.7472249118018555, - 0.6644467550042417, - 0.012862384967113366, - -0.6124991489851265 - ], - [ - 0.01844516952454416, - 0.0013883818830611348, - 0.9998289094224855, - -0.15699990301925867 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7534, - "backend_objective": 618.9411290844438, - "backend_elapsed_sec": 0.25701590001699515, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3998, - "objective": 996.4306885899134 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6380, - "objective": 682.3145767044045 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7534, - "objective": 618.9411290844438 - } - ], - "heldout_symmetric": { - "evaluated": 8055, - "inliers": 5587, - "inlier_ratio": 0.6936064556176288, - "inlier_rmse_m": 0.11914624513148218, - "median_m": 0.13621627379182125, - "p90_m": 0.8600601835813493, - "p95_m": 1.4045143272867981 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 56117.95752548433, - 62076.38713793777, - 102296.54126853116, - 288394.2705411583, - 377278.4721379689, - 740947.1453684517 - ], - "effective_rank": 6, - "scaled_condition_number": 13.20338761495324, - "weakest_scaled_direction": [ - 0.051016174699036056, - 0.2576350362613466, - -0.006718040289728429, - 0.06708912698257481, - 0.9359724157154417, - 0.22456867992859963 - ] - }, - "forward_reverse": { - "translation_m": 0.006090737153726605, - "rotation_deg": 0.027557138417491776 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6300346472626374e-15, - "rotation_deg": 5.074464279426559e-15 - }, - { - "translation_m": 1.6014269617894046e-15, - "rotation_deg": 1.39393558216266e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 25, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 18005, - "frame_counter_j": 21049, - "rtk_translation_m": 2.3747421598149763, - "rtk_rotation_deg": 12.391903814042255, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9771017898243449, - 0.20760605418763642, - -0.046602774452827594, - 0.6836770732221749 - ], - [ - -0.2055983985569553, - 0.9776271779696655, - 0.044434214361043896, - -2.5190907519197667 - ], - [ - 0.05478495078829861, - -0.033835294585802284, - 0.9979247376467901, - 0.10890575315662965 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9018, - "backend_objective": 1603.7263974893467, - "backend_elapsed_sec": 0.26418170001124963, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4428, - "objective": 998.9648775940758 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7152, - "objective": 717.1052366493561 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9018, - "objective": 1603.7263974893467 - } - ], - "heldout_symmetric": { - "evaluated": 8315, - "inliers": 6117, - "inlier_ratio": 0.7356584485868911, - "inlier_rmse_m": 0.11474070552638106, - "median_m": 0.12015080430215148, - "p90_m": 0.9353497010889523, - "p95_m": 1.5992612501748902 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 54421.15021016208, - 105983.75421454485, - 323054.79131014243, - 540615.0260132273, - 618302.5566564435, - 907398.3370898641 - ], - "effective_rank": 6, - "scaled_condition_number": 16.673633938013044, - "weakest_scaled_direction": [ - -0.07770890679458517, - 0.08356725539232165, - -0.02570066281607597, - -0.6620003139006165, - -0.7396449243682165, - -0.0315956613100559 - ] - }, - "forward_reverse": { - "translation_m": 0.0019617091597581428, - "rotation_deg": 0.011643770804738128 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.265271247595879e-15, - "rotation_deg": 2.1839510489416722e-14 - }, - { - "translation_m": 2.125986957094651e-15, - "rotation_deg": 3.950350296474579e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 26, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 18005, - "frame_counter_j": 21808, - "rtk_translation_m": 2.381693697571969, - "rtk_rotation_deg": 55.336301400509086, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.5729894523948887, - 0.8181138146333831, - -0.048712151976887726, - 1.2636919366293835 - ], - [ - -0.8170731700272349, - 0.5748682225294421, - 0.04379453787272056, - -2.6134549480717517 - ], - [ - 0.06383198466169512, - 0.014707584161026707, - 0.9978522759919404, - 0.1600384835630653 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 8745, - "backend_objective": 1826.9341443186427, - "backend_elapsed_sec": 0.2684796999965329, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4056, - "objective": 829.8679409775192 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6785, - "objective": 714.5244543941843 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 8745, - "objective": 1826.9341443186427 - } - ], - "heldout_symmetric": { - "evaluated": 8365, - "inliers": 6209, - "inlier_ratio": 0.7422594142259414, - "inlier_rmse_m": 0.11765221626900083, - "median_m": 0.12426046302590078, - "p90_m": 0.8632155686173443, - "p95_m": 1.6150154051765333 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 48759.960513395155, - 96351.33626100888, - 270164.12934271694, - 535278.7746145609, - 648762.17835789, - 920608.5530097359 - ], - "effective_rank": 6, - "scaled_condition_number": 18.880420396501957, - "weakest_scaled_direction": [ - 0.11387940859658063, - -0.014809023085159412, - 0.008417701523074536, - -0.020948786288663663, - 0.9921603932721736, - 0.04382028992443755 - ] - }, - "forward_reverse": { - "translation_m": 0.007814937371704293, - "rotation_deg": 0.039342553564881436 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.029911119502192e-15, - "rotation_deg": 2.2738102941910025e-14 - }, - { - "translation_m": 2.1719098162331255e-15, - "rotation_deg": 1.8576185042140407e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 27, - "lidar_time_i": 1784785587.5863533, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 18005, - "frame_counter_j": 22445, - "rtk_translation_m": 2.9603952927690247, - "rtk_rotation_deg": 80.62067670375279, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.166012302825228, - 0.9847987229204278, - -0.05110176753263577, - 1.3366643458092826 - ], - [ - -0.9849490568659734, - 0.16812033224592798, - 0.04013613414802536, - -3.010834914800446 - ], - [ - 0.04811725978787924, - 0.04366954567903789, - 0.9978866168511793, - 0.1758600044300586 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 8761, - "backend_objective": 1810.797605209733, - "backend_elapsed_sec": 0.3246029000147246, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4206, - "objective": 777.5638769913432 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6933, - "objective": 617.3102988788305 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 8761, - "objective": 1810.797605209733 - } - ], - "heldout_symmetric": { - "evaluated": 8375, - "inliers": 6076, - "inlier_ratio": 0.7254925373134329, - "inlier_rmse_m": 0.11870181965154768, - "median_m": 0.1292959264142726, - "p90_m": 0.9590407195444435, - "p95_m": 1.745903598461009 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 46053.05169249938, - 72111.06913739193, - 211058.3910644258, - 471445.30077424535, - 650959.6040704789, - 981362.4092437666 - ], - "effective_rank": 6, - "scaled_condition_number": 21.309389349405485, - "weakest_scaled_direction": [ - -0.11948805473642278, - -0.01662055490082298, - -0.008890942173840347, - 0.441601531324688, - -0.8876742358497826, - -0.04888610863579474 - ] - }, - "forward_reverse": { - "translation_m": 0.018241823604788005, - "rotation_deg": 0.08279236858582419 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0165297388272475e-05, - "rotation_deg": 0.00012138995368309731 - }, - { - "translation_m": 1.0165297388157148e-05, - "rotation_deg": 0.00012138995368611443 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785815.4779446, - "frame_counter_i": 18949, - "frame_counter_j": 20284, - "rtk_translation_m": 1.0880644725336985, - "rtk_rotation_deg": 34.41275457148609, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8303653571829605, - 0.5568321890913183, - -0.020767445249372744, - -1.2980342252265529 - ], - [ - -0.5567965397742828, - 0.8306104219770264, - 0.007996261534747364, - -0.7542815474137368 - ], - [ - 0.021702232276906368, - 0.004923423089373753, - 0.9997523558458277, - -0.03658754448586632 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 8752, - "backend_objective": 1203.4446402887475, - "backend_elapsed_sec": 0.31242710002698004, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4329, - "objective": 1028.7337646496203 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 7143, - "objective": 962.5315953290091 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 8752, - "objective": 1203.4446402887475 - } - ], - "heldout_symmetric": { - "evaluated": 7900, - "inliers": 6229, - "inlier_ratio": 0.7884810126582279, - "inlier_rmse_m": 0.10662565692629543, - "median_m": 0.1000611786088326, - "p90_m": 0.49960811562268803, - "p95_m": 0.75562531444527 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 88273.0773263409, - 146323.25466768251, - 301214.910506251, - 509707.2676784679, - 581465.7340907096, - 936683.2499807811 - ], - "effective_rank": 6, - "scaled_condition_number": 10.611199681165669, - "weakest_scaled_direction": [ - 0.10439883076038171, - 0.06970668489684709, - -0.02623880712496699, - 0.08206972040851741, - 0.9844977668795604, - 0.087075227352228 - ] - }, - "forward_reverse": { - "translation_m": 0.001882338148224756, - "rotation_deg": 0.020239211377623818 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.545131356005381e-15, - "rotation_deg": 2.0474535646795735e-14 - }, - { - "translation_m": 1.6667795129466248e-15, - "rotation_deg": 7.782331236869249e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 18949, - "frame_counter_j": 21049, - "rtk_translation_m": 5.033935954106079, - "rtk_rotation_deg": 2.213470053642494, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.997169096259311, - -0.04382697823854911, - -0.06109819509500086, - 4.877568649812088 - ], - [ - 0.045471268891624554, - 0.9986327846324579, - 0.025786142840836017, - -1.1221910117378027 - ], - [ - 0.05988453198259647, - -0.02849135721056768, - 0.9977986196590599, - 0.24009968082344962 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7951, - "backend_objective": 1006.816765698991, - "backend_elapsed_sec": 0.20475340000120923, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4289, - "objective": 794.1021285457281 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6627, - "objective": 631.1319767631088 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7951, - "objective": 1006.816765698991 - } - ], - "heldout_symmetric": { - "evaluated": 8160, - "inliers": 5584, - "inlier_ratio": 0.6843137254901961, - "inlier_rmse_m": 0.12171091934898426, - "median_m": 0.1421381414415025, - "p90_m": 1.0090705835968712, - "p95_m": 1.809914444995154 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 47597.81661202595, - 62200.586561324024, - 160526.5811565719, - 249100.31357856502, - 444442.7526783774, - 721145.4313586202 - ], - "effective_rank": 6, - "scaled_condition_number": 15.150809064137142, - "weakest_scaled_direction": [ - -0.07037591046685365, - 0.1140198174964063, - -0.019874373237302987, - -0.663823642849381, - -0.730267830000611, - -0.08774274552832399 - ] - }, - "forward_reverse": { - "translation_m": 0.014639828785635214, - "rotation_deg": 0.2046006298281892 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.554447978966673e-16, - "rotation_deg": 3.745587311483929e-15 - }, - { - "translation_m": 1.4980298966309074e-15, - "rotation_deg": 1.855039326368436e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 26, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 18949, - "frame_counter_j": 21808, - "rtk_translation_m": 5.765534437288107, - "rtk_rotation_deg": 40.730927532824346, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.758987705420829, - 0.6479688173745616, - -0.06382847899046681, - 5.465829429150644 - ], - [ - -0.6479656640797263, - 0.7613050131592317, - 0.02356215423811409, - -1.063367937083716 - ], - [ - 0.06386048225423888, - 0.023475277396298837, - 0.9976826901161628, - 0.32681663990174287 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7675, - "backend_objective": 941.0360150849585, - "backend_elapsed_sec": 0.20812529997783713, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3909, - "objective": 814.1334582930003 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6239, - "objective": 773.7425694523753 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7675, - "objective": 941.0360150849585 - } - ], - "heldout_symmetric": { - "evaluated": 8210, - "inliers": 5560, - "inlier_ratio": 0.6772228989037758, - "inlier_rmse_m": 0.12237954766026346, - "median_m": 0.14526492257361953, - "p90_m": 1.0306268199294264, - "p95_m": 2.005669170226921 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 42800.662748925846, - 50922.16795289156, - 123953.48099214467, - 229550.53710970332, - 436690.36093104834, - 701174.7556803013 - ], - "effective_rank": 6, - "scaled_condition_number": 16.382334072569904, - "weakest_scaled_direction": [ - -0.11074299337222478, - 0.11658102555223537, - -0.02291305551563881, - 0.005584858487071339, - -0.9700013384338984, - -0.18079286097412775 - ] - }, - "forward_reverse": { - "translation_m": 0.04518647006837157, - "rotation_deg": 0.20367965681897066 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.897961898453677e-15, - "rotation_deg": 5.0009294443592034e-15 - }, - { - "translation_m": 1.9868029630580076e-15, - "rotation_deg": 1.241119903764046e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 27, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 18949, - "frame_counter_j": 22445, - "rtk_translation_m": 6.392376191887118, - "rtk_rotation_deg": 66.01530283606805, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4078233430078444, - 0.9105921303916975, - -0.06709763756358932, - 5.632662344665416 - ], - [ - -0.9125328661541443, - 0.40898422649271754, - 0.0039586195391688415, - -1.421559241441168 - ], - [ - 0.03104656319801524, - 0.059614382063914104, - 0.9977385611294818, - 0.3729145284645733 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7658, - "backend_objective": 917.1304259230158, - "backend_elapsed_sec": 0.29475150001235306, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4032, - "objective": 864.9119736691032 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6245, - "objective": 634.8644050424682 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7658, - "objective": 917.1304259230158 - } - ], - "heldout_symmetric": { - "evaluated": 8220, - "inliers": 5456, - "inlier_ratio": 0.6637469586374696, - "inlier_rmse_m": 0.12340951265232122, - "median_m": 0.1525519977909689, - "p90_m": 1.1085815159634709, - "p95_m": 1.9974762679862905 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 36105.88521990672, - 48551.60355914683, - 88084.75813595018, - 196396.53562698688, - 424563.6450545413, - 745364.1125572154 - ], - "effective_rank": 6, - "scaled_condition_number": 20.64383986204732, - "weakest_scaled_direction": [ - -0.16486183891091427, - -0.024234837848935986, - -0.015867627903740262, - 0.43326911405518564, - -0.8776033093223075, - -0.11862449731157747 - ] - }, - "forward_reverse": { - "translation_m": 0.010626193556947957, - "rotation_deg": 1.1817079481882757 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.2334947784230958e-15, - "rotation_deg": 1.682681774252422e-14 - }, - { - "translation_m": 1.3355895042104052e-15, - "rotation_deg": 1.0551690582431039e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 23, - "j": 28, - "lidar_time_i": 1784785681.9825997, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 18949, - "frame_counter_j": 23009, - "rtk_translation_m": 6.631292861991925, - "rtk_rotation_deg": 85.8775990418248, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.07341209989437938, - 0.9950252891905618, - -0.06734491413861542, - 5.455047042241046 - ], - [ - -0.9972948325711798, - 0.0734944681127941, - -0.0012570137790975325, - -1.15646420109295 - ], - [ - 0.0036987181456562828, - 0.0672550148915107, - 0.9977289624221707, - 0.35030091842333066 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7810, - "backend_objective": 1093.1406190591376, - "backend_elapsed_sec": 0.20620700001018122, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 10, - "num_inliers": 4109, - "objective": 821.4602934406256 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6413, - "objective": 727.5235818224951 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7810, - "objective": 1093.1406190591376 - } - ], - "heldout_symmetric": { - "evaluated": 8196, - "inliers": 5508, - "inlier_ratio": 0.6720351390922401, - "inlier_rmse_m": 0.12122778564083748, - "median_m": 0.14439614877545376, - "p90_m": 1.1594785140716684, - "p95_m": 2.1256666818127967 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 38197.772408036675, - 67929.00079207728, - 124599.25696091478, - 217050.83145009523, - 455685.1258229141, - 733648.2155369003 - ], - "effective_rank": 6, - "scaled_condition_number": 19.20657067904157, - "weakest_scaled_direction": [ - -0.09092733851373148, - -0.09802132467259564, - -0.0170459577706576, - 0.7193665897423116, - -0.6791246999693235, - -0.055989515072139596 - ] - }, - "forward_reverse": { - "translation_m": 0.043540468687755365, - "rotation_deg": 0.26051478047218213 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.036560719766055e-16, - "rotation_deg": 1.6436786224923144e-14 - }, - { - "translation_m": 1.0310738718936457e-15, - "rotation_deg": 1.8968023343932963e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 25, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784785891.9768085, - "frame_counter_i": 20284, - "frame_counter_j": 21049, - "rtk_translation_m": 6.097212810998921, - "rtk_rotation_deg": 36.62622462512857, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8037124558199666, - -0.5924638785865632, - -0.05507123505065437, - 5.345160572627923 - ], - [ - 0.5936485267807685, - 0.8046965329251224, - 0.0067019809989590584, - 3.127250227813652 - ], - [ - 0.04034495025230932, - -0.038079423163350556, - 0.9984599353607962, - 0.14626802878837603 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7546, - "backend_objective": 744.3471485297614, - "backend_elapsed_sec": 0.1916874999878928, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 8, - "num_inliers": 4184, - "objective": 974.9759764826157 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6381, - "objective": 678.7033236838013 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7546, - "objective": 744.3471485297614 - } - ], - "heldout_symmetric": { - "evaluated": 8060, - "inliers": 5452, - "inlier_ratio": 0.6764267990074442, - "inlier_rmse_m": 0.12367636388755719, - "median_m": 0.14535752910830638, - "p90_m": 1.048725272468773, - "p95_m": 1.8248716260513014 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33258.99560449283, - 45622.66683737021, - 99853.21573369135, - 160709.2102426493, - 437514.98672329, - 715127.2315482453 - ], - "effective_rank": 6, - "scaled_condition_number": 21.50176872604179, - "weakest_scaled_direction": [ - 0.02843675660529166, - -0.07973190361574795, - 0.010765985098256993, - 0.665961301970352, - 0.7346630855210788, - 0.09738564080523619 - ] - }, - "forward_reverse": { - "translation_m": 0.035816405766439664, - "rotation_deg": 0.2046504337319023 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1487589816380692e-15, - "rotation_deg": 5.0505687259519916e-15 - }, - { - "translation_m": 2.7982245767451807e-15, - "rotation_deg": 1.4399710112546548e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 26, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 20284, - "frame_counter_j": 21808, - "rtk_translation_m": 6.852918693116795, - "rtk_rotation_deg": 6.318172961338249, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9922333814200585, - 0.1145048283550542, - -0.04859589570217054, - 5.7958564074555134 - ], - [ - -0.11540687172177772, - 0.9931866524713916, - -0.01617180608542132, - 3.501191269655094 - ], - [ - 0.04641304509628526, - 0.021654506137312367, - 0.9986875946004533, - 0.2429726836024844 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7180, - "backend_objective": 634.0063034620212, - "backend_elapsed_sec": 0.2115021999925375, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3830, - "objective": 931.0323149935704 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5986, - "objective": 657.0876311994764 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7180, - "objective": 634.0063034620212 - } - ], - "heldout_symmetric": { - "evaluated": 8110, - "inliers": 5291, - "inlier_ratio": 0.6524044389642417, - "inlier_rmse_m": 0.12740232296321938, - "median_m": 0.15791696390449692, - "p90_m": 1.1066659206443412, - "p95_m": 2.08872769310626 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 31584.723366238362, - 33646.81946362579, - 73798.39401154751, - 132207.01992072415, - 409364.83410575794, - 687064.1707586381 - ], - "effective_rank": 6, - "scaled_condition_number": 21.753053297058692, - "weakest_scaled_direction": [ - -0.046195805414765076, - -0.5601719258781283, - 0.004586770107849211, - 0.0501183307260803, - 0.5698624200757814, - 0.5973251189014677 - ] - }, - "forward_reverse": { - "translation_m": 0.062038641373543625, - "rotation_deg": 0.12012273822228971 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.078422011876594e-05, - "rotation_deg": 3.1647042461211275e-05 - }, - { - "translation_m": 1.2573000033218179e-15, - "rotation_deg": 2.549416660096853e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 27, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 20284, - "frame_counter_j": 22445, - "rtk_translation_m": 7.47982907414204, - "rtk_rotation_deg": 31.60254826458195, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8469031354259337, - 0.5296003181474226, - -0.047734497209786515, - 6.140728351631223 - ], - [ - -0.5307811203783928, - 0.8473601697476236, - -0.015879073497414676, - 3.293700223912932 - ], - [ - 0.03203874928238506, - 0.038784607042329104, - 0.9987338348133569, - 0.2654960125568915 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 7516, - "backend_objective": 667.5930873704444, - "backend_elapsed_sec": 0.16507250000722706, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3944, - "objective": 840.9891240548365 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6154, - "objective": 637.1289635887817 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 7516, - "objective": 667.5930873704444 - } - ], - "heldout_symmetric": { - "evaluated": 8120, - "inliers": 5316, - "inlier_ratio": 0.6546798029556651, - "inlier_rmse_m": 0.12425657449629145, - "median_m": 0.15393896893285075, - "p90_m": 1.1516355610045623, - "p95_m": 1.999530546617408 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29335.1476785254, - 32313.826658165886, - 107029.28681584133, - 158666.61917858713, - 445316.62183766696, - 771368.2715564844 - ], - "effective_rank": 6, - "scaled_condition_number": 26.295019203914197, - "weakest_scaled_direction": [ - -0.1901538352460994, - 0.34454765285068956, - -0.005218285199444599, - 0.32011626871378823, - -0.736610180760505, - -0.4472496165013398 - ] - }, - "forward_reverse": { - "translation_m": 0.05403266260962086, - "rotation_deg": 0.2126374478532415 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.996003610813204e-16, - "rotation_deg": 4.605446524171273e-15 - }, - { - "translation_m": 2.288783399261119e-15, - "rotation_deg": 2.1217215993856023e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 28, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 20284, - "frame_counter_j": 23009, - "rtk_translation_m": 7.71913193400284, - "rtk_rotation_deg": 51.4648444703387, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.6160692063343178, - 0.786448366038456, - -0.0442459101166126, - 5.842808758980054 - ], - [ - -0.7875915532957185, - 0.6159152148196876, - -0.018654579353494398, - 3.4060790395905705 - ], - [ - 0.012580865782675654, - 0.04634021697253352, - 0.9988464877583022, - 0.21870910666448412 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7575, - "backend_objective": 785.6163933136946, - "backend_elapsed_sec": 0.16993790000560693, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4061, - "objective": 816.6265355431033 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6273, - "objective": 547.7619565695693 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7575, - "objective": 785.6163933136946 - } - ], - "heldout_symmetric": { - "evaluated": 8096, - "inliers": 5355, - "inlier_ratio": 0.6614377470355731, - "inlier_rmse_m": 0.12010155595807545, - "median_m": 0.14361824572049778, - "p90_m": 1.1692406179640422, - "p95_m": 2.1281260879298185 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 37137.90476536972, - 47898.0641443855, - 116057.48949173345, - 161765.73249143673, - 477967.2992459121, - 779338.9669653369 - ], - "effective_rank": 6, - "scaled_condition_number": 20.98500095492876, - "weakest_scaled_direction": [ - 0.08737133007053412, - 0.08176300898116942, - 0.014245908396279698, - -0.7212728222428114, - 0.6786058362121803, - 0.06883131620616627 - ] - }, - "forward_reverse": { - "translation_m": 0.049490676797893776, - "rotation_deg": 0.25138526875505346 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.8041124150158794e-15, - "rotation_deg": 9.286521108177563e-15 - }, - { - "translation_m": 2.91961742936603e-15, - "rotation_deg": 6.625374322159671e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 24, - "j": 29, - "lidar_time_i": 1784785815.4779446, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 20284, - "frame_counter_j": 23738, - "rtk_translation_m": 7.213852273638132, - "rtk_rotation_deg": 93.73390958258973, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.07789535196048554, - 0.9954838120410153, - -0.05426135003150237, - 5.245345294378622 - ], - [ - -0.9955590617614847, - -0.080556389943159, - -0.04871162678374779, - 1.5374951999314395 - ], - [ - -0.05286273439338441, - 0.050225969414386146, - 0.9973378982615873, - 0.17208678595173332 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 7, - "backend_num_inliers": 7308, - "backend_objective": 704.6527652797474, - "backend_elapsed_sec": 0.2701965000014752, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3948, - "objective": 1315.4963899215252 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6066, - "objective": 755.7922256528994 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 7, - "num_inliers": 7308, - "objective": 704.6527652797474 - } - ], - "heldout_symmetric": { - "evaluated": 8173, - "inliers": 5411, - "inlier_ratio": 0.6620579958399608, - "inlier_rmse_m": 0.12331341986261203, - "median_m": 0.14922147684147558, - "p90_m": 1.1213653254212603, - "p95_m": 1.8946227473200987 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 28034.235731331548, - 32178.146071506486, - 83111.13785098991, - 176754.419581952, - 421217.2354252491, - 786244.8722705822 - ], - "effective_rank": 6, - "scaled_condition_number": 28.045882177977884, - "weakest_scaled_direction": [ - -0.05549317768166532, - -0.08738833604062834, - -0.001446016949543417, - 0.9906377650154883, - -0.024978391280038405, - -0.0854083923511201 - ] - }, - "forward_reverse": { - "translation_m": 0.08010108996241684, - "rotation_deg": 0.7934458070763889 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.6243534171511178e-15, - "rotation_deg": 8.198719303197444e-15 - }, - { - "translation_m": 2.1875901640420228e-15, - "rotation_deg": 5.0148127531719366e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 25, - "j": 26, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784785967.8726046, - "frame_counter_i": 21049, - "frame_counter_j": 21808, - "rtk_translation_m": 1.2882746074869595, - "rtk_rotation_deg": 42.944397586466835, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7313716875711438, - 0.6819525925861949, - -0.006009665906183032, - 0.5850745481396085 - ], - [ - -0.6819585651711088, - 0.7313896360104043, - 0.0013098573700309794, - 0.012785643189212282 - ], - [ - 0.00528866798907811, - 0.003140350543341257, - 0.9999810839157742, - 0.008412225013799873 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 10717, - "backend_objective": 896.0272190115661, - "backend_elapsed_sec": 0.21494720000191592, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4457, - "objective": 798.8759223413687 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7848, - "objective": 786.9690367435785 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 10717, - "objective": 896.0272190115661 - } - ], - "heldout_symmetric": { - "evaluated": 8370, - "inliers": 7648, - "inlier_ratio": 0.9137395459976105, - "inlier_rmse_m": 0.08148336624555251, - "median_m": 0.05743421568317374, - "p90_m": 0.2163420042617511, - "p95_m": 0.37440027658349145 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 88848.88528183637, - 185562.9121226117, - 676123.7167049383, - 1086866.5454814287, - 1338905.0165305706, - 1471598.2724376265 - ], - "effective_rank": 6, - "scaled_condition_number": 16.56293455758718, - "weakest_scaled_direction": [ - -0.09767941896623245, - 0.03742658747895111, - -4.4651086247527834e-05, - 0.02349769517463645, - -0.9921603066308485, - -0.06421653941190857 - ] - }, - "forward_reverse": { - "translation_m": 0.0032405549728505064, - "rotation_deg": 0.006669174585592186 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.085676725552168e-15, - "rotation_deg": 8.066687809837768e-15 - }, - { - "translation_m": 9.882520346876628e-16, - "rotation_deg": 1.217548544597636e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 21049, - "frame_counter_j": 22445, - "rtk_translation_m": 1.7666235781584831, - "rtk_rotation_deg": 68.22877288971053, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.36702706331897667, - 0.9302025039038019, - -0.003799542412717431, - 0.7533153977236753 - ], - [ - -0.9300302048074911, - 0.36687259357372154, - -0.02117352663652828, - -0.3313800739769612 - ], - [ - -0.018301719514425444, - 0.01130494650978545, - 0.999768595849673, - 0.12219054211233012 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 10102, - "backend_objective": 1901.4627168987183, - "backend_elapsed_sec": 0.2560974000080023, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4498, - "objective": 744.956145408769 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 8, - "num_inliers": 7839, - "objective": 1484.6798496111398 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 10102, - "objective": 1901.4627168987183 - } - ], - "heldout_symmetric": { - "evaluated": 8380, - "inliers": 7204, - "inlier_ratio": 0.8596658711217183, - "inlier_rmse_m": 0.1096145882030974, - "median_m": 0.09658349576477937, - "p90_m": 0.3010394894270168, - "p95_m": 0.5190085385386899 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 58508.399852741386, - 112772.73207991506, - 407285.1416356718, - 950524.5007495433, - 1117838.8726784028, - 1298193.3499779669 - ], - "effective_rank": 6, - "scaled_condition_number": 22.188153380460985, - "weakest_scaled_direction": [ - 0.11582136965640447, - 0.006775672884857004, - -0.0031695562618341616, - -0.444176497896815, - 0.8858491014024351, - 0.06714210870678693 - ] - }, - "forward_reverse": { - "translation_m": 0.010624789877375215, - "rotation_deg": 0.04475651255674721 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1157603309187458e-15, - "rotation_deg": 1.2964800201870834e-14 - }, - { - "translation_m": 1.1270951119217139e-15, - "rotation_deg": 8.828731538409577e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 21049, - "frame_counter_j": 23009, - "rtk_translation_m": 2.1807182972588706, - "rtk_rotation_deg": 88.09106909546726, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.02794331794125587, - 0.9996064287993573, - -0.002481629591481865, - 0.5681087878779979 - ], - [ - -0.9991739702289111, - 0.027857778875472358, - -0.029585830613996573, - -0.06670213050185261 - ], - [ - -0.029505053794709486, - 0.003306305962961535, - 0.9995591629020518, - 0.0500650443896828 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 10552, - "backend_objective": 2861.084834640379, - "backend_elapsed_sec": 0.24945939998724498, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 4687, - "objective": 643.3150383452406 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 8027, - "objective": 1242.5097169540672 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 10552, - "objective": 2861.084834640379 - } - ], - "heldout_symmetric": { - "evaluated": 8356, - "inliers": 7386, - "inlier_ratio": 0.8839157491622786, - "inlier_rmse_m": 0.10490699814192792, - "median_m": 0.08733797867234977, - "p90_m": 0.27613606960126924, - "p95_m": 0.45402360858994406 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 82682.27780212459, - 168903.71160245605, - 579325.9813725054, - 998001.6970349033, - 1092190.697411184, - 1337152.6367189726 - ], - "effective_rank": 6, - "scaled_condition_number": 16.17217948348072, - "weakest_scaled_direction": [ - 0.11472414333302709, - 0.03951060954025923, - 0.0001699842521189172, - -0.7186913158127679, - 0.6809548722664951, - 0.07113724964775964 - ] - }, - "forward_reverse": { - "translation_m": 0.00283419137499405, - "rotation_deg": 0.01585308444597649 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.486410087150353e-16, - "rotation_deg": 5.4383157099047935e-15 - }, - { - "translation_m": 2.5814177514652363e-16, - "rotation_deg": 3.123360171724331e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 29, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 21049, - "frame_counter_j": 23738, - "rtk_translation_m": 1.118287177357716, - "rtk_rotation_deg": 130.36013420771832, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6554792015639561, - 0.7549125044169012, - -0.02131025556114215, - -1.0138501579695602 - ], - [ - -0.7545811072038546, - -0.6558240423309178, - -0.022409331800375746, - -1.2140408425635585 - ], - [ - -0.030892862736944093, - 0.0013914653200317241, - 0.9995217330584555, - -0.002294027421849833 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 9034, - "backend_objective": 2403.9096357295875, - "backend_elapsed_sec": 0.4588002000236884, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 4353, - "objective": 952.0955781454228 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 7273, - "objective": 1439.2033568838797 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 9034, - "objective": 2403.9096357295875 - } - ], - "heldout_symmetric": { - "evaluated": 8433, - "inliers": 6626, - "inlier_ratio": 0.7857227558401518, - "inlier_rmse_m": 0.10954358768244267, - "median_m": 0.10404570310842254, - "p90_m": 0.5234137980728498, - "p95_m": 0.8807189068936676 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 51884.27121437365, - 88957.88715316734, - 350078.58413763496, - 622505.5550395454, - 712259.1771191398, - 1044538.6717588378 - ], - "effective_rank": 6, - "scaled_condition_number": 20.132087187715307, - "weakest_scaled_direction": [ - -0.05802820528677275, - -0.11681861725609159, - -0.001750376414787551, - 0.9897821556355021, - -0.021841515083976522, - -0.053266376264503666 - ] - }, - "forward_reverse": { - "translation_m": 0.003247718742817276, - "rotation_deg": 0.01654235380830592 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.226122722799655e-15, - "rotation_deg": 8.065997532841954e-15 - }, - { - "translation_m": 1.8992045430510203e-15, - "rotation_deg": 5.700431053920051e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 30, - "lidar_time_i": 1784785891.9768085, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 21049, - "frame_counter_j": 24656, - "rtk_translation_m": 5.200639419572971, - "rtk_rotation_deg": 139.6773015481418, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7415485874203189, - -0.6660735023609188, - -0.08032298517605073, - 4.525145551100874 - ], - [ - 0.6654541280464478, - -0.7454621282082621, - 0.03817091658780073, - -2.4433543515895604 - ], - [ - -0.08530237957334219, - -0.02514567278619407, - 0.9960377498766088, - 0.17361152672414779 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 21, - "backend_num_inliers": 513, - "backend_objective": 31.346284680384496, - "backend_elapsed_sec": 1.0109276000002865, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 1567, - "objective": 1208.1949907460148 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 10, - "num_inliers": 864, - "objective": 177.5990880881666 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 21, - "num_inliers": 513, - "objective": 31.346284680384496 - } - ], - "heldout_symmetric": { - "evaluated": 8516, - "inliers": 431, - "inlier_ratio": 0.05061061531235322, - "inlier_rmse_m": 0.1582745227634446, - "median_m": 1.42219165658378, - "p90_m": 2.427038301987774, - "p95_m": 2.5902417498933428 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 490.56635159621055, - 928.9750833523664, - 2194.934872528774, - 4278.563375388558, - 10170.689040138004, - 91502.51629630265 - ], - "effective_rank": 6, - "scaled_condition_number": 186.52424080569466, - "weakest_scaled_direction": [ - -0.38213351048531646, - 0.7052186120236066, - 0.056981623225864926, - -0.06150354909882429, - -0.07327753384469574, - 0.5867209733051143 - ] - }, - "forward_reverse": { - "translation_m": 2.4401001990983833, - "rotation_deg": 2.63047633237589 - }, - "multistart": { - "runs": 2, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.4421042140292295, - "rotation_deg": 2.6582641602075454 - }, - { - "translation_m": 2.442104214029229, - "rotation_deg": 2.658264160207536 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - }, - { - "i": 26, - "j": 27, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786031.5701303, - "frame_counter_i": 21808, - "frame_counter_j": 22445, - "rtk_translation_m": 0.6269948654714946, - "rtk_rotation_deg": 25.284375303243706, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9031238228982453, - 0.42936522833220914, - -0.0035862533219896066, - 0.3711056724989209 - ], - [ - -0.4293644705776282, - 0.9031307300292244, - 0.001017783116865379, - -0.16482795850516016 - ], - [ - 0.0036758562611237788, - 0.0006206255795685741, - 0.9999930514281776, - -0.00431354725569091 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 10938, - "backend_objective": 811.4525406525992, - "backend_elapsed_sec": 0.5273160000215285, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 4560, - "objective": 697.2650492601973 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7929, - "objective": 836.697144741172 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 10938, - "objective": 811.4525406525992 - } - ], - "heldout_symmetric": { - "evaluated": 8430, - "inliers": 7746, - "inlier_ratio": 0.9188612099644128, - "inlier_rmse_m": 0.07520973241900301, - "median_m": 0.05006018473217023, - "p90_m": 0.2065512482149949, - "p95_m": 0.3969314123730229 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 81174.14337404088, - 182451.9623876915, - 838767.3286421337, - 1199884.464186407, - 1351752.9872742943, - 1688345.1910577079 - ], - "effective_rank": 6, - "scaled_condition_number": 20.799051531446562, - "weakest_scaled_direction": [ - -0.1269279557441927, - 0.02012257977112855, - -0.0017961179609769589, - 0.4377816793914065, - -0.8836447183718741, - -0.10488261379730929 - ] - }, - "forward_reverse": { - "translation_m": 0.0009920873307779914, - "rotation_deg": 0.005485007138529723 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1748807752764097e-15, - "rotation_deg": 6.123065417021022e-15 - }, - { - "translation_m": 1.1639597030080818e-15, - "rotation_deg": 4.367736559971788e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 21808, - "frame_counter_j": 23009, - "rtk_translation_m": 0.9431372257108486, - "rtk_rotation_deg": 45.14667150900044, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7028250963491841, - 0.7113623889080027, - -0.0006599915605569055, - 0.06176536518270879 - ], - [ - -0.7113623873202674, - 0.7028253528132222, - 0.00027811684655332475, - -0.08328071175713206 - ], - [ - 0.0006617006657618818, - 0.00027402567265381606, - 0.9999997435310471, - -0.0005954271732827069 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 10801, - "backend_objective": 534.3181664847554, - "backend_elapsed_sec": 0.24122669998905621, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 4748, - "objective": 949.241284802782 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 8171, - "objective": 2513.5391287730927 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 10801, - "objective": 534.3181664847554 - } - ], - "heldout_symmetric": { - "evaluated": 8406, - "inliers": 7719, - "inlier_ratio": 0.9182726623840114, - "inlier_rmse_m": 0.07611768518866212, - "median_m": 0.04059061585430375, - "p90_m": 0.2131478655757597, - "p95_m": 0.3964615713414412 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 70976.23343319376, - 181819.20958525562, - 701367.5341389945, - 1143311.0848255146, - 1289037.393578862, - 1561152.034862002 - ], - "effective_rank": 6, - "scaled_condition_number": 21.99541958409829, - "weakest_scaled_direction": [ - 0.11100222475416983, - 0.03730020252776459, - -0.005526869779433164, - -0.718387168296327, - 0.6814336336374053, - 0.07631994546879904 - ] - }, - "forward_reverse": { - "translation_m": 0.004984978187527545, - "rotation_deg": 0.01173507098896779 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.862885956556085e-15, - "rotation_deg": 1.1543706216566264e-14 - }, - { - "translation_m": 5.725780892750994e-16, - "rotation_deg": 9.415390911130637e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 21808, - "frame_counter_j": 23738, - "rtk_translation_m": 1.129925637779203, - "rtk_rotation_deg": 87.41573662125148, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.03470211380194069, - 0.9993562264174981, - -0.009104725051107616, - -0.3199563418092457 - ], - [ - -0.9979879755715075, - 0.03416801226538895, - -0.05340924594596154, - -2.0200754492118658 - ], - [ - -0.05306377212714095, - 0.010939819852782688, - 0.9985311995271997, - -0.09378114241650533 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 11, - "backend_num_inliers": 8873, - "backend_objective": 1718.246953239026, - "backend_elapsed_sec": 0.3087177000124939, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 4289, - "objective": 1236.2616643766012 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7010, - "objective": 806.1100880618494 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 11, - "num_inliers": 8873, - "objective": 1718.246953239026 - } - ], - "heldout_symmetric": { - "evaluated": 8483, - "inliers": 6665, - "inlier_ratio": 0.7856890251090416, - "inlier_rmse_m": 0.10851393061782179, - "median_m": 0.10143193500378025, - "p90_m": 0.613143045155214, - "p95_m": 1.065452953971831 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 50718.15353182033, - 66920.8825730492, - 272296.88582538516, - 504975.2009951135, - 799466.7762627929, - 1231467.3343045514 - ], - "effective_rank": 6, - "scaled_condition_number": 24.280602674778656, - "weakest_scaled_direction": [ - -0.1343026045163772, - -0.12563575499113513, - -0.0014824618167600682, - 0.9743919766035696, - -0.0292761146792842, - -0.126013708915979 - ] - }, - "forward_reverse": { - "translation_m": 0.002586732426991948, - "rotation_deg": 0.12205883610743135 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1631705747361533e-15, - "rotation_deg": 1.4531212682559473e-15 - }, - { - "translation_m": 9.413396663333419e-16, - "rotation_deg": 5.8135293892927e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 30, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 21808, - "frame_counter_j": 24656, - "rtk_translation_m": 4.786676837961511, - "rtk_rotation_deg": 177.3783008654109, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9974292127156142, - 0.03631759761098321, - -0.061773762434199055, - 2.145004548824874 - ], - [ - -0.0352676660442237, - -0.9992157338795015, - -0.018003024730385207, - 0.733319309887677 - ], - [ - -0.06237914197312488, - -0.0157781263595033, - 0.9979277996805584, - 0.026047788577808137 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8333, - "backend_objective": 1334.6131690579562, - "backend_elapsed_sec": 0.22547109998413362, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 25, - "num_inliers": 3452, - "objective": 587.1121524439146 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6167, - "objective": 655.6197665540117 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8333, - "objective": 1334.6131690579562 - } - ], - "heldout_symmetric": { - "evaluated": 8566, - "inliers": 6540, - "inlier_ratio": 0.7634835395750642, - "inlier_rmse_m": 0.10495724850674527, - "median_m": 0.09958217844133398, - "p90_m": 0.8079791151263384, - "p95_m": 1.9302179280166931 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 34608.15543152247, - 43123.61476388403, - 265715.63854269474, - 534108.713761383, - 872393.6286266362, - 1204587.854791304 - ], - "effective_rank": 6, - "scaled_condition_number": 34.80647378548578, - "weakest_scaled_direction": [ - 0.25610437555097615, - -0.45385472793807113, - 0.012603992969949959, - 0.11723039710974674, - 0.5237828482246814, - -0.6634577123014321 - ] - }, - "forward_reverse": { - "translation_m": 0.008489213184554775, - "rotation_deg": 0.021733210949123293 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.891945847262976e-15, - "rotation_deg": 5.087485327230505e-15 - }, - { - "translation_m": 4.910462595695867e-15, - "rotation_deg": 8.542034387957128e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 31, - "lidar_time_i": 1784785967.8726046, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 21808, - "frame_counter_j": 25326, - "rtk_translation_m": 5.900105669197046, - "rtk_rotation_deg": 156.01119868987135, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9122387381878188, - -0.4056624164439269, - -0.05708317120108187, - 3.2956587640528574 - ], - [ - 0.4079638769679036, - -0.9122642474158343, - -0.036598059731900244, - -0.8535051567956543 - ], - [ - -0.037228478867862326, - -0.056674039662766997, - 0.9976983981091123, - 0.03190686813244759 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8035, - "backend_objective": 1360.6468693381212, - "backend_elapsed_sec": 0.4356205000076443, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 23, - "num_inliers": 3546, - "objective": 792.9137338629299 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5988, - "objective": 682.8940585433361 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8035, - "objective": 1360.6468693381212 - } - ], - "heldout_symmetric": { - "evaluated": 8595, - "inliers": 6338, - "inlier_ratio": 0.7374054682955207, - "inlier_rmse_m": 0.1073752166304431, - "median_m": 0.10542758911588943, - "p90_m": 1.1270312775215576, - "p95_m": 2.1121570469362694 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 25562.79723986299, - 47259.09442307519, - 180655.21775123425, - 520835.8011581698, - 565827.6674258974, - 979324.959882305 - ], - "effective_rank": 6, - "scaled_condition_number": 38.310555401782544, - "weakest_scaled_direction": [ - 0.5497644522988888, - -0.3449139678242669, - 0.01788339127548114, - 0.03787743567272247, - 0.19409353179768077, - -0.7344158133413747 - ] - }, - "forward_reverse": { - "translation_m": 3.545322953478412, - "rotation_deg": 6.459518815762061 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1335697856308468e-15, - "rotation_deg": 9.803592197741278e-15 - }, - { - "translation_m": 3.607797795906347e-15, - "rotation_deg": 1.9007776078639457e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 27, - "j": 28, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786087.9670725, - "frame_counter_i": 22445, - "frame_counter_j": 23009, - "rtk_translation_m": 0.44809323479571145, - "rtk_rotation_deg": 19.862296205756735, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.9401636714419392, - 0.340710825668522, - 0.0028989951859020122, - -0.30982350683162074 - ], - [ - -0.3407145091518092, - 0.940166399919804, - 0.0008739080482501667, - -0.06844035829680675 - ], - [ - -0.002427787934636656, - -0.0018093463209435973, - 0.9999954160453112, - 0.004464905912215504 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 2, - "backend_num_inliers": 10951, - "backend_objective": 606.427818622809, - "backend_elapsed_sec": 0.23274229999515228, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 3, - "num_inliers": 4630, - "objective": 785.1952992467598 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 7968, - "objective": 665.954811389006 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 2, - "num_inliers": 10951, - "objective": 606.427818622809 - } - ], - "heldout_symmetric": { - "evaluated": 8416, - "inliers": 7811, - "inlier_ratio": 0.9281131178707225, - "inlier_rmse_m": 0.07220943509634768, - "median_m": 0.04403731701321004, - "p90_m": 0.18811562604495502, - "p95_m": 0.35130106173559117 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 80494.2534737146, - 175075.44312705335, - 730889.9384384095, - 1199289.3073850137, - 1368295.5925724502, - 1617387.850535562 - ], - "effective_rank": 6, - "scaled_condition_number": 20.093208902964978, - "weakest_scaled_direction": [ - 0.10736818645139508, - 0.04302190485030222, - -0.009815833958952223, - -0.7190468066944476, - 0.6821067206175224, - 0.0650149914697148 - ] - }, - "forward_reverse": { - "translation_m": 0.0023003913248606234, - "rotation_deg": 0.001591751329336308 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.163476238331114e-07, - "rotation_deg": 3.901481935045663e-06 - }, - { - "translation_m": 5.16347623981922e-07, - "rotation_deg": 3.901481943855486e-06 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 22445, - "frame_counter_j": 23738, - "rtk_translation_m": 1.160064136065596, - "rtk_rotation_deg": 62.13136131800778, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.4603406364378266, - 0.8876594728866564, - 0.012130896034518506, - 0.17600019957694304 - ], - [ - -0.8863148311795953, - 0.46033210760629706, - -0.05040209060971998, - -1.9661618016540414 - ], - [ - -0.05032413412173226, - 0.012450337398184026, - 0.9986553312447537, - -0.06846817441094133 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 8880, - "backend_objective": 1797.1522464890595, - "backend_elapsed_sec": 0.261398399976315, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4191, - "objective": 929.6927939889017 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 6954, - "objective": 972.9245680162205 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 8880, - "objective": 1797.1522464890595 - } - ], - "heldout_symmetric": { - "evaluated": 8493, - "inliers": 6685, - "inlier_ratio": 0.7871188037207112, - "inlier_rmse_m": 0.10966659884725236, - "median_m": 0.1013574723040456, - "p90_m": 0.6097610864767999, - "p95_m": 1.1171204843093478 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 48953.914449273216, - 55627.427153821314, - 200295.46744734797, - 533135.2292310877, - 736133.048259916, - 1175366.3563208021 - ], - "effective_rank": 6, - "scaled_condition_number": 24.009650087098436, - "weakest_scaled_direction": [ - 0.6288058814174804, - 0.06176772657280194, - 0.011765505283860358, - -0.3584361755409766, - 0.10035521707405917, - 0.6797807167048837 - ] - }, - "forward_reverse": { - "translation_m": 0.005134403698947268, - "rotation_deg": 0.02434844099203523 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.1654319641736672e-06, - "rotation_deg": 1.3319221287504758e-06 - }, - { - "translation_m": 1.8875832159447663e-15, - "rotation_deg": 1.4289164825074108e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 30, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 22445, - "frame_counter_j": 24656, - "rtk_translation_m": 4.25412615059095, - "rtk_rotation_deg": 152.09392556214777, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.8858100038464864, - 0.4617939319265986, - -0.045683711771922236, - 1.2149879932777539 - ], - [ - -0.4601979802113168, - -0.8868485055821013, - -0.04144330049860193, - 1.5745421322554765 - ], - [ - -0.05965279620363769, - -0.015687338288083108, - 0.9980959128873953, - 0.03012566588523843 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8603, - "backend_objective": 932.2985470706495, - "backend_elapsed_sec": 0.32478230001288466, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 20, - "num_inliers": 3428, - "objective": 592.3834397069093 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 6246, - "objective": 563.2209285662157 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8603, - "objective": 932.2985470706495 - } - ], - "heldout_symmetric": { - "evaluated": 8576, - "inliers": 6794, - "inlier_ratio": 0.7922108208955224, - "inlier_rmse_m": 0.10147035321534553, - "median_m": 0.09296588374800516, - "p90_m": 0.6966962167797762, - "p95_m": 1.8399922016318797 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 37244.06072129195, - 48286.955476247414, - 268579.3673766598, - 590504.9734161941, - 908007.6380703546, - 1211186.5539530334 - ], - "effective_rank": 6, - "scaled_condition_number": 32.52026042532504, - "weakest_scaled_direction": [ - 0.24302748907356825, - -0.5283085195279866, - 0.008403922224003341, - 0.1320219287158497, - 0.2866465022740477, - -0.7497740425702917 - ] - }, - "forward_reverse": { - "translation_m": 2.795897032209197, - "rotation_deg": 3.237329131939042 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.0412626584890197e-15, - "rotation_deg": 8.617247519670353e-15 - }, - { - "translation_m": 4.100410761679928e-15, - "rotation_deg": 1.4536384404548027e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 27, - "j": 31, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 22445, - "frame_counter_j": 25326, - "rtk_translation_m": 5.542871649427442, - "rtk_rotation_deg": 178.70442600700352, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9979050969720873, - 0.027048344939739035, - -0.05876907752508933, - 2.9551238370121546 - ], - [ - -0.02438447450158951, - -0.9986629634765509, - -0.0455816057584045, - 0.6360386591134417 - ], - [ - -0.05992340811744937, - -0.04405306364209158, - 0.9972304210879925, - 0.12763394698924757 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 18, - "backend_num_inliers": 8212, - "backend_objective": 1945.2520928958277, - "backend_elapsed_sec": 0.4023098000034224, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 3541, - "objective": 848.0741224013657 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6058, - "objective": 738.3764268966495 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 18, - "num_inliers": 8212, - "objective": 1945.2520928958277 - } - ], - "heldout_symmetric": { - "evaluated": 8605, - "inliers": 6533, - "inlier_ratio": 0.7592097617664149, - "inlier_rmse_m": 0.10539218018667602, - "median_m": 0.09975911295463522, - "p90_m": 0.934381824440062, - "p95_m": 1.947541804572434 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21284.524566160035, - 50498.56072291494, - 196205.67657885855, - 586911.4100698163, - 707743.5279134141, - 1036698.9438283719 - ], - "effective_rank": 6, - "scaled_condition_number": 48.70669958381899, - "weakest_scaled_direction": [ - -0.5042087794991646, - 0.35714258261121634, - -0.022252976236679236, - -0.07805772187664457, - -0.13395131148577685, - 0.7705138062468655 - ] - }, - "forward_reverse": { - "translation_m": 0.0020939062619997405, - "rotation_deg": 0.027400662783563425 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.973770779879594e-15, - "rotation_deg": 3.3489973535643038e-15 - }, - { - "translation_m": 6.802565439066017e-15, - "rotation_deg": 4.80949775543364e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 32, - "lidar_time_i": 1784786031.5701303, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 22445, - "frame_counter_j": 26097, - "rtk_translation_m": 4.8829350360277, - "rtk_rotation_deg": 138.47370648510565, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.7509458718206748, - -0.6582121815948044, - -0.05326369866704795, - 2.363796238809033 - ], - [ - 0.6596818205039412, - -0.7513908553151719, - -0.015220980432944523, - 2.4157428282491122 - ], - [ - -0.03000322136190244, - -0.046567226124634424, - 0.9984644711550658, - 0.15847722034810396 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 7709, - "backend_objective": 1211.2523576835517, - "backend_elapsed_sec": 0.17869219998829067, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3336, - "objective": 667.1961574044783 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5716, - "objective": 705.92570708828 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 7709, - "objective": 1211.2523576835517 - } - ], - "heldout_symmetric": { - "evaluated": 8620, - "inliers": 6448, - "inlier_ratio": 0.7480278422273782, - "inlier_rmse_m": 0.10408734715846867, - "median_m": 0.0983782577351282, - "p90_m": 0.8872251371988249, - "p95_m": 1.815939689403135 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 24167.684967358422, - 40654.13815137258, - 215584.83416971556, - 442620.2257086406, - 573999.9884323122, - 1020241.2859588515 - ], - "effective_rank": 6, - "scaled_condition_number": 42.21510199826003, - "weakest_scaled_direction": [ - -0.5733559641826801, - -0.0929364770007991, - -0.02977883986877105, - 0.0198099718342983, - -0.12686307680730688, - 0.8032759768808019 - ] - }, - "forward_reverse": { - "translation_m": 0.004407463145306061, - "rotation_deg": 0.03490543724836902 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.3751912131156618e-15, - "rotation_deg": 3.7446554573462103e-14 - }, - { - "translation_m": 2.713491258038064e-15, - "rotation_deg": 2.785942364838836e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786160.8647907, - "frame_counter_i": 23009, - "frame_counter_j": 23738, - "rtk_translation_m": 1.5995723610319212, - "rtk_rotation_deg": 42.26906511225104, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7362093340643086, - 0.6767167344736805, - 0.007090678378428652, - 1.071413985458336 - ], - [ - -0.6766225434918797, - 0.7362324645170495, - -0.011987152694923479, - -1.6090303957898822 - ], - [ - -0.013332294444994276, - 0.004027340863361518, - 0.9999030105217218, - -0.13494438029632055 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 13, - "backend_num_inliers": 9029, - "backend_objective": 2843.675226565929, - "backend_elapsed_sec": 0.2490686000091955, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 4341, - "objective": 967.4364779901053 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 7264, - "objective": 1279.8645767110825 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 13, - "num_inliers": 9029, - "objective": 2843.675226565929 - } - ], - "heldout_symmetric": { - "evaluated": 8469, - "inliers": 6672, - "inlier_ratio": 0.787814381863266, - "inlier_rmse_m": 0.10901449493832843, - "median_m": 0.10481026201629562, - "p90_m": 0.49592047017348523, - "p95_m": 0.9056696238048947 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 39538.16289007739, - 73499.54792276234, - 351689.45700439246, - 613087.5863189875, - 774062.685912839, - 1024577.1429155618 - ], - "effective_rank": 6, - "scaled_condition_number": 25.913625419675043, - "weakest_scaled_direction": [ - 0.045933636579248004, - 0.09429090142979553, - 0.003066408361722544, - -0.993221521831769, - 0.01689164427106617, - 0.04707021353175564 - ] - }, - "forward_reverse": { - "translation_m": 0.01570175790237609, - "rotation_deg": 0.03569660498137675 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.99936494731956e-15, - "rotation_deg": 7.502018180733867e-15 - }, - { - "translation_m": 2.4531909608143503e-15, - "rotation_deg": 6.622111658022343e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 23009, - "frame_counter_j": 24656, - "rtk_translation_m": 4.295353381127667, - "rtk_rotation_deg": 132.23162935639104, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6760087824505582, - 0.7362190438779801, - -0.03152214271124597, - 0.8901568205649555 - ], - [ - -0.7342642564077458, - -0.6765905457056717, - -0.05550887517940145, - 2.0513879361745273 - ], - [ - -0.06219427475013507, - -0.014378904446975304, - 0.9979604798263357, - 0.02732725021921613 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 3, - "backend_num_inliers": 8462, - "backend_objective": 1033.3872289347796, - "backend_elapsed_sec": 0.2416990000056103, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 19, - "num_inliers": 3483, - "objective": 568.8961922406211 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 6204, - "objective": 662.5935048543948 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 3, - "num_inliers": 8462, - "objective": 1033.3872289347796 - } - ], - "heldout_symmetric": { - "evaluated": 8552, - "inliers": 6663, - "inlier_ratio": 0.7791159962581852, - "inlier_rmse_m": 0.10438560755009844, - "median_m": 0.09728337532058973, - "p90_m": 0.7630484928580537, - "p95_m": 1.8669807591970238 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32498.535827997093, - 48640.37423220076, - 226554.466392085, - 609517.9859190829, - 795092.4034258014, - 1186251.087853302 - ], - "effective_rank": 6, - "scaled_condition_number": 36.501677925790155, - "weakest_scaled_direction": [ - 0.26948518494585755, - -0.540064648301011, - 0.010842450381565585, - 0.13578550124464578, - 0.203205014896343, - -0.7588546445747322 - ] - }, - "forward_reverse": { - "translation_m": 0.01170149615735483, - "rotation_deg": 0.047047156693309715 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.206618228699196e-15, - "rotation_deg": 1.9431428923939297e-14 - }, - { - "translation_m": 3.0473359533946916e-15, - "rotation_deg": 1.163749918839277e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 31, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 23009, - "frame_counter_j": 25326, - "rtk_translation_m": 5.754426930327516, - "rtk_rotation_deg": 158.8421298011293, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9303902474071115, - 0.36508188963208027, - -0.033003051259009854, - 2.8284182836168354 - ], - [ - -0.363087190802378, - -0.9301888111610445, - -0.05400432821580924, - 1.7633871918800694 - ], - [ - -0.05041507120864407, - -0.038262115120220756, - 0.9979951558707858, - 0.15634937405808638 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8121, - "backend_objective": 1740.6035833865592, - "backend_elapsed_sec": 0.2890383999911137, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 17, - "num_inliers": 3597, - "objective": 824.8767919640718 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 6094, - "objective": 736.988474503722 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8121, - "objective": 1740.6035833865592 - } - ], - "heldout_symmetric": { - "evaluated": 8581, - "inliers": 6392, - "inlier_ratio": 0.7449015266285981, - "inlier_rmse_m": 0.10668967013687296, - "median_m": 0.10531341138130089, - "p90_m": 1.0053754405662703, - "p95_m": 1.9627586238932788 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20995.693414343335, - 46707.725316051285, - 211564.8757680219, - 621586.3891891531, - 652107.4291910302, - 1008766.8481560131 - ], - "effective_rank": 6, - "scaled_condition_number": 48.04636971250818, - "weakest_scaled_direction": [ - 0.5227914353597811, - -0.3659326834521487, - 0.020922125281067794, - 0.06950211817973835, - 0.14035396052457247, - -0.7535349177730843 - ] - }, - "forward_reverse": { - "translation_m": 0.024421374377245158, - "rotation_deg": 0.6810283060803514 - }, - "multistart": { - "runs": 2, - "success_rate": 0.5, - "deltas": [ - { - "translation_m": 2.278870654723489, - "rotation_deg": 27.152572051918433 - }, - { - "translation_m": 4.279482949896486e-12, - "rotation_deg": 2.088674083980014e-12 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_rotation" - ] - }, - { - "i": 28, - "j": 32, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 23009, - "frame_counter_j": 26097, - "rtk_translation_m": 5.013331477001236, - "rtk_rotation_deg": 158.33600269086247, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.930669944618636, - -0.3630363556170548, - -0.04536583167796383, - 1.6790276087030118 - ], - [ - 0.36443428954838386, - -0.9308247556134477, - -0.027439441294071252, - 3.227669784651088 - ], - [ - -0.03226612441727374, - -0.042069927946849925, - 0.9985935200959575, - 0.11020026838055202 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 7569, - "backend_objective": 1075.938284372832, - "backend_elapsed_sec": 0.3297512999852188, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 14, - "num_inliers": 3395, - "objective": 826.2633861070965 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5667, - "objective": 605.0213239756274 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 7569, - "objective": 1075.938284372832 - } - ], - "heldout_symmetric": { - "evaluated": 8596, - "inliers": 6283, - "inlier_ratio": 0.7309213587715216, - "inlier_rmse_m": 0.1081318944415262, - "median_m": 0.10796326250295199, - "p90_m": 0.927995728766249, - "p95_m": 1.8889543501782344 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 18586.731567653023, - 37160.3785405743, - 169659.12510311973, - 437141.69031035266, - 531025.7996655877, - 970929.9037441188 - ], - "effective_rank": 6, - "scaled_condition_number": 52.23779663520043, - "weakest_scaled_direction": [ - -0.5713487278042236, - -0.07494505129605988, - -0.02146221614858828, - 0.03239816051334563, - -0.13023859300458032, - 0.8058979537685004 - ] - }, - "forward_reverse": { - "translation_m": 0.10324080390042788, - "rotation_deg": 0.9479198721286788 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.9429398559897372e-15, - "rotation_deg": 6.776927420547786e-15 - }, - { - "translation_m": 1.1123893155135927e-15, - "rotation_deg": 1.8791633839924055e-14 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 28, - "j": 33, - "lidar_time_i": 1784786087.9670725, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 23009, - "frame_counter_j": 27704, - "rtk_translation_m": 5.317102997899902, - "rtk_rotation_deg": 67.05379893079937, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.38788467389975195, - -0.9214830197874527, - -0.020359862403267318, - 4.252162874860791 - ], - [ - 0.9216187963002136, - 0.3880597018431465, - -0.005334989367779181, - 2.841996708458498 - ], - [ - 0.012816944246934511, - -0.0166946712697575, - 0.9997784824106623, - 0.11143063248591845 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6283, - "backend_objective": 1056.6324024222768, - "backend_elapsed_sec": 0.27772909999475814, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 9, - "num_inliers": 3033, - "objective": 1220.7479350341719 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 6, - "num_inliers": 4774, - "objective": 734.7842473071777 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6283, - "objective": 1056.6324024222768 - } - ], - "heldout_symmetric": { - "evaluated": 8269, - "inliers": 5534, - "inlier_ratio": 0.6692465836255895, - "inlier_rmse_m": 0.10871806386783629, - "median_m": 0.1283207800220331, - "p90_m": 1.3608911810867883, - "p95_m": 2.616512527570886 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 15810.591547811695, - 30211.336260541786, - 81867.35983763795, - 293456.19450604514, - 695822.1083108579, - 864424.5280670088 - ], - "effective_rank": 6, - "scaled_condition_number": 54.67376255043738, - "weakest_scaled_direction": [ - -0.11114038125185813, - -0.527895538293014, - -0.00588732862552283, - 0.0559357125845531, - -0.05816039858535397, - 0.838109789801567 - ] - }, - "forward_reverse": { - "translation_m": 0.13259351588266985, - "rotation_deg": 0.659391929056215 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 6.78877776696119e-16, - "rotation_deg": 3.7452646711452355e-15 - }, - { - "translation_m": 8.920730087951354e-16, - "rotation_deg": 8.034144267400096e-15 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 29, - "j": 30, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786252.6621523, - "frame_counter_i": 23738, - "frame_counter_j": 24656, - "rtk_translation_m": 4.099530130205247, - "rtk_rotation_deg": 89.96256424413995, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.0012310923998671594, - 0.9998865761692972, - -0.015010636493604798, - -2.6507392467255673 - ], - [ - -0.9991148525963036, - 0.0005987037388502235, - -0.042061299020595536, - 2.5514434876541814 - ], - [ - -0.042047541342745014, - 0.015049131213237437, - 0.9990022662220331, - -0.04552237979568302 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 8030, - "backend_objective": 1713.3749243544414, - "backend_elapsed_sec": 0.23009660001844168, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 7, - "num_inliers": 3414, - "objective": 805.3447701288949 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 3, - "num_inliers": 5991, - "objective": 736.3476657437233 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 8030, - "objective": 1713.3749243544414 - } - ], - "heldout_symmetric": { - "evaluated": 8629, - "inliers": 6317, - "inlier_ratio": 0.7320662880982732, - "inlier_rmse_m": 0.10929719051930432, - "median_m": 0.11164279747018017, - "p90_m": 0.9234305725909965, - "p95_m": 2.032984862051835 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33224.82407489841, - 39053.3839477185, - 164344.4175094853, - 626745.4953590671, - 656812.6616835463, - 1021509.0142151543 - ], - "effective_rank": 6, - "scaled_condition_number": 30.745355096911158, - "weakest_scaled_direction": [ - -0.09413487569020736, - 0.4337575868847141, - -0.005227092736285117, - -0.10771559349826082, - -0.6632402506699799, - 0.5928535901120993 - ] - }, - "forward_reverse": { - "translation_m": 0.005463604154015333, - "rotation_deg": 0.018583483487870766 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 2.1868857395626282e-15, - "rotation_deg": 1.1175442615353005e-14 - }, - { - "translation_m": 1.850747526296523e-15, - "rotation_deg": 8.419547904429345e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 23738, - "frame_counter_j": 25326, - "rtk_translation_m": 4.890018768530818, - "rtk_rotation_deg": 116.57306468887772, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.43723742875106525, - 0.8991826513046896, - -0.017146150933295943, - -1.0307989602890875 - ], - [ - -0.8979979722858205, - -0.43754615711202294, - -0.04640045438415313, - 3.6543370157340873 - ], - [ - -0.04922471604501145, - -0.004890806597201827, - 0.9987757542817691, - 0.049133468528889244 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 7925, - "backend_objective": 1769.8076883626966, - "backend_elapsed_sec": 0.26582209998741746, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 16, - "num_inliers": 3617, - "objective": 960.0819434627389 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5985, - "objective": 876.4566638599943 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 7925, - "objective": 1769.8076883626966 - } - ], - "heldout_symmetric": { - "evaluated": 8658, - "inliers": 6281, - "inlier_ratio": 0.7254562254562255, - "inlier_rmse_m": 0.11323336570178015, - "median_m": 0.11723386613510434, - "p90_m": 1.064547564398538, - "p95_m": 1.9809746034725115 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 20136.7696123405, - 42871.465324088065, - 131612.35066134, - 556857.0961299242, - 689799.0153677568, - 988650.7333495542 - ], - "effective_rank": 6, - "scaled_condition_number": 49.09678922599757, - "weakest_scaled_direction": [ - 0.4277393915199425, - -0.4105567476274941, - 0.02892181270051879, - 0.06063468721320484, - 0.1660065808691613, - -0.785118429591668 - ] - }, - "forward_reverse": { - "translation_m": 0.0050777995851252426, - "rotation_deg": 0.07265894091769333 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0681389886409907e-15, - "rotation_deg": 2.7113317337090846e-15 - }, - { - "translation_m": 1.6699540590904642e-15, - "rotation_deg": 5.663873124781354e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 23738, - "frame_counter_j": 26097, - "rtk_translation_m": 4.464737187763289, - "rtk_rotation_deg": 159.39493219688632, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9287022426398309, - 0.36526535866124465, - -0.063979389476768, - -2.8821443153763675 - ], - [ - -0.363403678551462, - -0.9308121962196632, - -0.03906944821716455, - 3.95876649188571 - ], - [ - -0.07382351204740314, - -0.013033538690647307, - 0.9971861490906231, - -0.04150580210044566 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7098, - "backend_objective": 847.1028890149273, - "backend_elapsed_sec": 0.208673799992539, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 15, - "num_inliers": 3252, - "objective": 928.1174362656283 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 4, - "num_inliers": 5284, - "objective": 613.0189434739622 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7098, - "objective": 847.1028890149273 - } - ], - "heldout_symmetric": { - "evaluated": 8673, - "inliers": 6035, - "inlier_ratio": 0.695837657096737, - "inlier_rmse_m": 0.10999820041072961, - "median_m": 0.11856484192304849, - "p90_m": 1.3695983452465426, - "p95_m": 2.318369261085353 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 12816.872775093498, - 34624.611186322, - 79864.7620104077, - 306966.31397232565, - 446538.5579148462, - 926081.3919820852 - ], - "effective_rank": 6, - "scaled_condition_number": 72.25486343140591, - "weakest_scaled_direction": [ - -0.5609358943007624, - -0.031757345479722976, - -0.04242343532856239, - -0.044892356341308934, - -0.10186183904800453, - 0.8186278078076092 - ] - }, - "forward_reverse": { - "translation_m": 0.011220553177198233, - "rotation_deg": 0.14599088546526143 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.286180355332504e-15, - "rotation_deg": 4.1196618816307535e-14 - }, - { - "translation_m": 4.332083504579744e-15, - "rotation_deg": 3.9682054577800965e-14 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 33, - "lidar_time_i": 1784786160.8647907, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 23738, - "frame_counter_j": 27704, - "rtk_translation_m": 4.34670323578768, - "rtk_rotation_deg": 109.32286404305042, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.3386836842782954, - -0.9398351256887554, - -0.04475822299064756, - -0.7156186018327474 - ], - [ - 0.9408521283995702, - -0.3387642703034672, - -0.0060034699764541614, - 5.422264417082001 - ], - [ - -0.009520214791617123, - -0.04414414669421295, - 0.9989798095171697, - 0.10687802099727334 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 5, - "backend_num_inliers": 6193, - "backend_objective": 744.6490346717907, - "backend_elapsed_sec": 0.17971780002699234, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 2951, - "objective": 711.086820565191 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 4635, - "objective": 437.3265497556991 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 5, - "num_inliers": 6193, - "objective": 744.6490346717907 - } - ], - "heldout_symmetric": { - "evaluated": 8346, - "inliers": 5327, - "inlier_ratio": 0.6382698298586149, - "inlier_rmse_m": 0.11215583949685817, - "median_m": 0.14520929531596044, - "p90_m": 1.5015977974792296, - "p95_m": 2.812255846305743 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 11286.92840920206, - 33496.067983452005, - 46351.05198108295, - 286588.33751607593, - 437386.25194414007, - 820182.2073539195 - ], - "effective_rank": 6, - "scaled_condition_number": 72.66655529463955, - "weakest_scaled_direction": [ - -0.0767098257039795, - -0.5433899373229041, - -0.018979886948973443, - 0.06663396687063634, - -0.02082048815085103, - 0.8328320144424819 - ] - }, - "forward_reverse": { - "translation_m": 0.018977478007060265, - "rotation_deg": 0.05615608666616428 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.318490179505439e-15, - "rotation_deg": 1.2660751159554717e-14 - }, - { - "translation_m": 1.6919522065759386e-15, - "rotation_deg": 7.834568279051473e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 31, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786319.6581354, - "frame_counter_i": 24656, - "frame_counter_j": 25326, - "rtk_translation_m": 2.3862917603439455, - "rtk_rotation_deg": 26.61050044473775, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.8989475344036485, - 0.43787368498375995, - 0.012647781953582345, - -1.1119692098002136 - ], - [ - -0.43784633789327093, - 0.8990359023877583, - -0.0050030601916877535, - 1.6142148563367478 - ], - [ - -0.013561518464172369, - -0.0010402963870578753, - 0.9999074972218043, - 0.06670916408811281 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 4, - "backend_num_inliers": 9030, - "backend_objective": 2838.56174256091, - "backend_elapsed_sec": 0.21705209999345243, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 4, - "num_inliers": 3832, - "objective": 649.4384598184905 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6674, - "objective": 1247.530375303141 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 4, - "num_inliers": 9030, - "objective": 2838.56174256091 - } - ], - "heldout_symmetric": { - "evaluated": 8741, - "inliers": 7243, - "inlier_ratio": 0.8286237272623269, - "inlier_rmse_m": 0.0964659694513182, - "median_m": 0.0815457046710185, - "p90_m": 0.448596515484814, - "p95_m": 0.79004098341329 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 39614.968185220445, - 56182.379478586656, - 439112.9640769325, - 708330.6129733466, - 1136223.0809684258, - 1625605.49026203 - ], - "effective_rank": 6, - "scaled_condition_number": 41.03513305025223, - "weakest_scaled_direction": [ - -0.5038215917986367, - 0.3795009264482512, - -0.02492737521847699, - -0.04265298956337161, - -0.21924065971527756, - 0.7427218402848003 - ] - }, - "forward_reverse": { - "translation_m": 0.018905314487385798, - "rotation_deg": 0.08632503464137033 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 1.0077414646998453e-15, - "rotation_deg": 5.347190835862908e-15 - }, - { - "translation_m": 8.879886640496848e-16, - "rotation_deg": 8.906732277533139e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 24656, - "frame_counter_j": 26097, - "rtk_translation_m": 1.1507634071714652, - "rtk_rotation_deg": 69.43236795274659, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.3635790250163329, - 0.9315010454563274, - -0.010774733497488831, - -1.4000417256838453 - ], - [ - -0.9313244073617958, - 0.3631994931620142, - -0.026851004060477888, - -0.22813528469719024 - ], - [ - -0.0210983606086435, - 0.019797234166048228, - 0.9995813767267787, - -0.017082824030759496 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8420, - "backend_objective": 1522.3805554597175, - "backend_elapsed_sec": 0.19040469999890774, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 6, - "num_inliers": 3718, - "objective": 842.3184574635156 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 6364, - "objective": 996.5050498034586 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8420, - "objective": 1522.3805554597175 - } - ], - "heldout_symmetric": { - "evaluated": 8756, - "inliers": 7062, - "inlier_ratio": 0.8065326633165829, - "inlier_rmse_m": 0.09815063400019142, - "median_m": 0.08081841340365783, - "p90_m": 0.4790676298185709, - "p95_m": 0.8509769492049389 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 33159.95234572108, - 61064.351291159524, - 300223.63441742276, - 580862.1428546602, - 1012404.3729176935, - 1169099.16978869 - ], - "effective_rank": 6, - "scaled_condition_number": 35.25635856167173, - "weakest_scaled_direction": [ - 0.5881064317233109, - 0.05070078092882424, - 0.03823123726649609, - 0.001175631167941189, - 0.13265592976422702, - -0.7952984662789812 - ] - }, - "forward_reverse": { - "translation_m": 0.007341509941520892, - "rotation_deg": 0.023973741904832375 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 4.967007407645019e-16, - "rotation_deg": 1.129323802870724e-14 - }, - { - "translation_m": 1.0968776017955963e-15, - "rotation_deg": 9.356307217897543e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 33, - "lidar_time_i": 1784786252.6621523, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 24656, - "frame_counter_j": 27704, - "rtk_translation_m": 2.4361832484951105, - "rtk_rotation_deg": 160.7145717128102, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.9400013202324404, - 0.3385127577275178, - -0.04250447996366474, - -2.856095359067646 - ], - [ - -0.3379804420015197, - -0.9409539976099159, - -0.01935962826027831, - 1.9422371207085336 - ], - [ - -0.046548241489107356, - -0.003832393198706708, - 0.9989086915112121, - -0.09300301217907853 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 8, - "backend_num_inliers": 6823, - "backend_objective": 1135.817399835205, - "backend_elapsed_sec": 0.3080756000126712, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 25, - "num_inliers": 3121, - "objective": 692.6900700881857 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 2, - "num_inliers": 5122, - "objective": 629.0793980265928 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 8, - "num_inliers": 6823, - "objective": 1135.817399835205 - } - ], - "heldout_symmetric": { - "evaluated": 8429, - "inliers": 5871, - "inlier_ratio": 0.6965239055641239, - "inlier_rmse_m": 0.10032655671840386, - "median_m": 0.10289132389486434, - "p90_m": 1.433755765502277, - "p95_m": 2.8449510457378637 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 21269.049129287097, - 43220.49541138773, - 143861.22694174797, - 374188.2654787455, - 858092.1463472905, - 1001548.3325752582 - ], - "effective_rank": 6, - "scaled_condition_number": 47.08947384000088, - "weakest_scaled_direction": [ - 0.029213001468576423, - -0.5652672682847729, - -0.023650617681046388, - 0.06413597024714679, - -0.056655594406544565, - 0.8195955619555723 - ] - }, - "forward_reverse": { - "translation_m": 2.6257249086936962, - "rotation_deg": 3.1197630566421646 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 9.671732905683864e-16, - "rotation_deg": 6.176094161148719e-15 - }, - { - "translation_m": 1.7607443281164592e-15, - "rotation_deg": 7.464986187847517e-16 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation", - "forward_reverse_rotation" - ] - }, - { - "i": 31, - "j": 32, - "lidar_time_i": 1784786319.6581354, - "lidar_time_j": 1784786396.7558627, - "frame_counter_i": 25326, - "frame_counter_j": 26097, - "rtk_translation_m": 1.2514382602180638, - "rtk_rotation_deg": 42.82186750800885, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - 0.7353113602326208, - 0.6777277042877701, - -0.0015369950169060941, - 0.5530845769120833 - ], - [ - -0.6774253813669432, - 0.7349116437545313, - -0.031618484370138845, - -1.7917526299146316 - ], - [ - -0.02029916729091594, - 0.02429063018618735, - 0.9994988289600204, - -0.10343719713454098 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 6, - "backend_num_inliers": 8422, - "backend_objective": 2055.9101310021338, - "backend_elapsed_sec": 0.2686489000043366, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 5, - "num_inliers": 3699, - "objective": 762.3984311068843 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 7, - "num_inliers": 6339, - "objective": 1077.2456436698762 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 6, - "num_inliers": 8422, - "objective": 2055.9101310021338 - } - ], - "heldout_symmetric": { - "evaluated": 8785, - "inliers": 7157, - "inlier_ratio": 0.8146841206602162, - "inlier_rmse_m": 0.09914628416022417, - "median_m": 0.07863922529321844, - "p90_m": 0.48657998937736363, - "p95_m": 0.9652907911717594 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 29897.54623750982, - 58540.09758264833, - 335733.4103235305, - 598662.87959459, - 824114.362410073, - 1026434.5393505907 - ], - "effective_rank": 6, - "scaled_condition_number": 34.33173181492779, - "weakest_scaled_direction": [ - 0.6139279563856824, - 0.08135787148474027, - 0.03614189759065114, - -0.024105337993162983, - 0.13915399307834964, - -0.7715064635145351 - ] - }, - "forward_reverse": { - "translation_m": 0.06936877058296162, - "rotation_deg": 0.45703051311645637 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 3.67237313403358e-16, - "rotation_deg": 6.140570249398282e-15 - }, - { - "translation_m": 6.533255114602682e-16, - "rotation_deg": 5.631533653209629e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 33, - "lidar_time_i": 1784786319.6581354, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 25326, - "frame_counter_j": 27704, - "rtk_translation_m": 0.641507519046697, - "rtk_rotation_deg": 134.10407126807203, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.6960818822066489, - 0.7173572674847195, - -0.029471410731518533, - -1.7220967320600726 - ], - [ - -0.7158947868474338, - -0.6966053187872006, - -0.04728302022978844, - -0.48226454262285273 - ], - [ - -0.05444875965820372, - -0.01181442441423255, - 0.9984466695559878, - -0.06326391574421514 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 9, - "backend_num_inliers": 7550, - "backend_objective": 1621.057072695131, - "backend_elapsed_sec": 0.3225730999838561, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": true, - "iterations": 11, - "num_inliers": 3389, - "objective": 675.7652685443331 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": true, - "iterations": 5, - "num_inliers": 5781, - "objective": 1650.7089582896813 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 9, - "num_inliers": 7550, - "objective": 1621.057072695131 - } - ], - "heldout_symmetric": { - "evaluated": 8458, - "inliers": 6387, - "inlier_ratio": 0.7551430598250177, - "inlier_rmse_m": 0.1003246191461096, - "median_m": 0.08751950331668279, - "p90_m": 0.8156765153565828, - "p95_m": 2.0828499949927592 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 32757.33367444599, - 67334.04675645688, - 175860.31026392666, - 428422.7141007091, - 788425.2815674562, - 934807.4930133051 - ], - "effective_rank": 6, - "scaled_condition_number": 28.537349904719164, - "weakest_scaled_direction": [ - 0.014200388727543551, - -0.5662779138973728, - -0.02580493319100964, - 0.08471808496748096, - -0.00467411957355558, - 0.8193062780796254 - ] - }, - "forward_reverse": { - "translation_m": 0.005559091155811048, - "rotation_deg": 0.0330053182501105 - }, - "multistart": { - "runs": 2, - "success_rate": 1.0, - "deltas": [ - { - "translation_m": 5.095246377785861e-16, - "rotation_deg": 7.369239496130195e-15 - }, - { - "translation_m": 1.7452973491944015e-15, - "rotation_deg": 6.13197128276296e-15 - } - ] - }, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 32, - "j": 33, - "lidar_time_i": 1784786396.7558627, - "lidar_time_j": 1784786557.4492514, - "frame_counter_i": 26097, - "frame_counter_j": 27704, - "rtk_translation_m": 1.4370687242949811, - "rtk_rotation_deg": 91.2822037600631, - "nearest_rtk_dt_i_s": 0.0, - "nearest_rtk_dt_j_s": 0.0, - "initial_B_source": "X0=identity; B0=A (no measured extrinsic)", - "B_ij_4x4": [ - [ - -0.03553714800116292, - 0.9993149516431566, - -0.010331434284676484, - -1.3966905543976256 - ], - [ - -0.9987095986600396, - -0.03588712491476379, - -0.03593399239793585, - 1.6567592534208615 - ], - [ - -0.0362801413482118, - 0.009041110981913531, - 0.9993007603599455, - 0.18107882372357556 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "backend": "small_gicp", - "backend_converged": true, - "backend_iterations": 18, - "backend_num_inliers": 434, - "backend_objective": 19.5164628284166, - "backend_elapsed_sec": 0.6570993000059389, - "multiscale_stages": [ - { - "voxel_m": 0.3, - "max_correspondence_m": 1.2, - "converged": false, - "iterations": 59, - "num_inliers": 1049, - "objective": 883.1483573831881 - }, - { - "voxel_m": 0.15, - "max_correspondence_m": 0.5, - "converged": false, - "iterations": 59, - "num_inliers": 845, - "objective": 182.6938800328335 - }, - { - "voxel_m": 0.08, - "max_correspondence_m": 0.25, - "converged": true, - "iterations": 18, - "num_inliers": 434, - "objective": 19.5164628284166 - } - ], - "heldout_symmetric": { - "evaluated": 8473, - "inliers": 368, - "inlier_ratio": 0.043432078366576185, - "inlier_rmse_m": 0.1661924920133195, - "median_m": 1.3116363900492476, - "p90_m": 2.516004269498909, - "p95_m": 2.6755523843181948 - }, - "hessian": { - "native_order": [ - "rx_rad", - "ry_rad", - "rz_rad", - "tx_m", - "ty_m", - "tz_m" - ], - "scaled_eigenvalues": [ - 642.7747431708625, - 954.735320433794, - 1133.575997940253, - 1939.7523753118437, - 14074.629767093451, - 56882.75167846326 - ], - "effective_rank": 6, - "scaled_condition_number": 88.4956235178996, - "weakest_scaled_direction": [ - 0.12024798769106836, - -0.6749797371841314, - 0.08183100517680016, - -0.05162316535972436, - -0.20059941130013623, - 0.6930666543869539 - ] - }, - "forward_reverse": { - "translation_m": 0.946171384319174, - "rotation_deg": 3.5092968853566924 - }, - "multistart": { - "runs": 2, - "success_rate": 0.0, - "deltas": [ - { - "translation_m": 2.5266613224139265, - "rotation_deg": 1.139524458087656 - }, - { - "translation_m": 0.8870093669430473, - "rotation_deg": 5.456250095042409 - } - ] - }, - "accepted": false, - "rejection_reasons": [ - "heldout_inlier_ratio", - "heldout_inlier_rmse", - "forward_reverse_translation", - "forward_reverse_rotation", - "multistart_instability" - ] - } - ] -} \ No newline at end of file diff --git a/results/02_data4_calibration/small_gicp/B_refined.npz b/results/02_data4_calibration/small_gicp/B_refined.npz deleted file mode 100644 index 5843ea1..0000000 Binary files a/results/02_data4_calibration/small_gicp/B_refined.npz and /dev/null differ diff --git a/results/02_data4_calibration/small_gicp/B_refined.refinement.json b/results/02_data4_calibration/small_gicp/B_refined.refinement.json deleted file mode 100644 index 79e3046..0000000 --- a/results/02_data4_calibration/small_gicp/B_refined.refinement.json +++ /dev/null @@ -1,1666 +0,0 @@ -{ - "selection_is_X_independent": true, - "criteria": { - "min_inlier_ratio": 0.7, - "max_inlier_rmse_m": 0.13, - "max_rotation_invariant_error_deg": 0.75, - "reverse_translation_tolerance_m": 0.05, - "reverse_rotation_tolerance_deg": 0.5 - }, - "input_pairs": 133, - "accepted_pairs": 57, - "pairs": [ - { - "i": 0, - "j": 1, - "heldout_inlier_ratio": 0.8193962748876044, - "heldout_inlier_rmse_m": 0.11049677170760565, - "rotation_invariant_error_deg": 0.03734008173614711, - "reverse_translation_m": 0.026680306344951596, - "reverse_rotation_deg": 0.12400141971813113, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 2, - "heldout_inlier_ratio": 0.7525388867463684, - "heldout_inlier_rmse_m": 0.11492533799497681, - "rotation_invariant_error_deg": 0.6760112300786432, - "reverse_translation_m": 0.0018465318763874656, - "reverse_rotation_deg": 0.03093450642761156, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 0, - "j": 3, - "heldout_inlier_ratio": 0.628093901505486, - "heldout_inlier_rmse_m": 0.12365050970311489, - "rotation_invariant_error_deg": 0.3329548009851493, - "reverse_translation_m": 0.010524333328229862, - "reverse_rotation_deg": 0.23898233567763014, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 0, - "j": 5, - "heldout_inlier_ratio": 0.6015065913370998, - "heldout_inlier_rmse_m": 0.12959862169013578, - "rotation_invariant_error_deg": 0.8874651368963384, - "reverse_translation_m": 0.013711901937629547, - "reverse_rotation_deg": 0.26024107991311357, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 1, - "j": 3, - "heldout_inlier_ratio": 0.678820988438572, - "heldout_inlier_rmse_m": 0.12109867185657652, - "rotation_invariant_error_deg": 0.28201354980991766, - "reverse_translation_m": 0.008324315958289934, - "reverse_rotation_deg": 0.25689852176843175, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 1, - "j": 4, - "heldout_inlier_ratio": 0.6772473651580905, - "heldout_inlier_rmse_m": 0.11157492180388107, - "rotation_invariant_error_deg": 0.23808884059471325, - "reverse_translation_m": 0.00802452890723869, - "reverse_rotation_deg": 0.011334867255723058, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 1, - "j": 6, - "heldout_inlier_ratio": 0.6933789087226231, - "heldout_inlier_rmse_m": 0.12162612003144421, - "rotation_invariant_error_deg": 0.0750432131524672, - "reverse_translation_m": 0.008258211706006158, - "reverse_rotation_deg": 0.08942722541817279, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 2, - "j": 3, - "heldout_inlier_ratio": 0.7609663064208518, - "heldout_inlier_rmse_m": 0.11583878636897658, - "rotation_invariant_error_deg": 0.03805484899682254, - "reverse_translation_m": 0.00784220284106163, - "reverse_rotation_deg": 0.01711532312869618, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 4, - "heldout_inlier_ratio": 0.796748976299789, - "heldout_inlier_rmse_m": 0.11484342359047915, - "rotation_invariant_error_deg": 0.8619802082203449, - "reverse_translation_m": 0.011210942709507262, - "reverse_rotation_deg": 0.11462542679280045, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 2, - "j": 5, - "heldout_inlier_ratio": 0.7112112112112112, - "heldout_inlier_rmse_m": 0.12001317983504071, - "rotation_invariant_error_deg": 0.19305622476466944, - "reverse_translation_m": 0.011298647069299764, - "reverse_rotation_deg": 0.02158504824207679, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 6, - "heldout_inlier_ratio": 0.7254529329785886, - "heldout_inlier_rmse_m": 0.11794151013960824, - "rotation_invariant_error_deg": 0.5959529359404385, - "reverse_translation_m": 0.004729020804343234, - "reverse_rotation_deg": 0.026463705119922912, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 2, - "j": 7, - "heldout_inlier_ratio": 0.7569187603621987, - "heldout_inlier_rmse_m": 0.11528530285715083, - "rotation_invariant_error_deg": 0.6006463589923925, - "reverse_translation_m": 0.011994525026310043, - "reverse_rotation_deg": 0.05882394078371607, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 4, - "heldout_inlier_ratio": 0.6957378664695738, - "heldout_inlier_rmse_m": 0.11619002437046372, - "rotation_invariant_error_deg": 0.5055042717460125, - "reverse_translation_m": 0.006018969660459514, - "reverse_rotation_deg": 0.057234124307389854, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 3, - "j": 5, - "heldout_inlier_ratio": 0.7989069680784996, - "heldout_inlier_rmse_m": 0.1077590577814381, - "rotation_invariant_error_deg": 0.5566178981223597, - "reverse_translation_m": 0.01353229173052898, - "reverse_rotation_deg": 0.06486032517688407, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 6, - "heldout_inlier_ratio": 0.8435613682092555, - "heldout_inlier_rmse_m": 0.11222309863990207, - "rotation_invariant_error_deg": 0.24279409865246748, - "reverse_translation_m": 0.009512765198853305, - "reverse_rotation_deg": 0.09743636874085052, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 7, - "heldout_inlier_ratio": 0.8651898734177215, - "heldout_inlier_rmse_m": 0.11184568072686094, - "rotation_invariant_error_deg": 0.23371684353352862, - "reverse_translation_m": 0.010827690226297962, - "reverse_rotation_deg": 0.12520280777371934, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 3, - "j": 8, - "heldout_inlier_ratio": 0.825590155700653, - "heldout_inlier_rmse_m": 0.10787987267070262, - "rotation_invariant_error_deg": 0.07359256633802147, - "reverse_translation_m": 0.0056088079192386986, - "reverse_rotation_deg": 0.021536601402145895, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 5, - "heldout_inlier_ratio": 0.6652516676773802, - "heldout_inlier_rmse_m": 0.12444356767629798, - "rotation_invariant_error_deg": 1.0678050691619134, - "reverse_translation_m": 0.003155412913416372, - "reverse_rotation_deg": 0.05824374716659687, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 4, - "j": 6, - "heldout_inlier_ratio": 0.6551681807021851, - "heldout_inlier_rmse_m": 0.12030857820705748, - "rotation_invariant_error_deg": 0.2827020035717851, - "reverse_translation_m": 0.011212969141455763, - "reverse_rotation_deg": 0.08373658947114908, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 7, - "heldout_inlier_ratio": 0.696936001976773, - "heldout_inlier_rmse_m": 0.11799538994568655, - "rotation_invariant_error_deg": 0.2724963846557813, - "reverse_translation_m": 0.00409529177569414, - "reverse_rotation_deg": 0.0519770010059835, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 4, - "j": 8, - "heldout_inlier_ratio": 0.7129198332924737, - "heldout_inlier_rmse_m": 0.11349036082807595, - "rotation_invariant_error_deg": 0.5804550654619618, - "reverse_translation_m": 0.01249802665331653, - "reverse_rotation_deg": 0.04549823831834878, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 4, - "j": 9, - "heldout_inlier_ratio": 0.6097234068478128, - "heldout_inlier_rmse_m": 0.11677937926620108, - "rotation_invariant_error_deg": 0.19151228540169996, - "reverse_translation_m": 0.00616984405743089, - "reverse_rotation_deg": 0.11548555225177864, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 5, - "j": 6, - "heldout_inlier_ratio": 0.7604901596732269, - "heldout_inlier_rmse_m": 0.11101741624951145, - "rotation_invariant_error_deg": 0.8151323864865176, - "reverse_translation_m": 0.01028641250952863, - "reverse_rotation_deg": 0.031127073736479716, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 5, - "j": 7, - "heldout_inlier_ratio": 0.8092687180764918, - "heldout_inlier_rmse_m": 0.10777871969807898, - "rotation_invariant_error_deg": 0.8022146383376452, - "reverse_translation_m": 0.010579714886860828, - "reverse_rotation_deg": 0.03333492483252218, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 5, - "j": 8, - "heldout_inlier_ratio": 0.7295760721789643, - "heldout_inlier_rmse_m": 0.11311887218463837, - "rotation_invariant_error_deg": 0.47747890472797394, - "reverse_translation_m": 0.009759205787181369, - "reverse_rotation_deg": 0.05935114015788255, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 5, - "j": 10, - "heldout_inlier_ratio": 0.5442391832766165, - "heldout_inlier_rmse_m": 0.13173165083201857, - "rotation_invariant_error_deg": 0.7193738704903865, - "reverse_translation_m": 0.00523999417676037, - "reverse_rotation_deg": 0.17134499262937464, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 6, - "j": 7, - "heldout_inlier_ratio": 0.8539354187689203, - "heldout_inlier_rmse_m": 0.10462253085153163, - "rotation_invariant_error_deg": 0.02516390454564643, - "reverse_translation_m": 0.002843314342407394, - "reverse_rotation_deg": 0.028424505305675103, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 8, - "heldout_inlier_ratio": 0.7757757757757757, - "heldout_inlier_rmse_m": 0.1131640002846509, - "rotation_invariant_error_deg": 0.3191267376297162, - "reverse_translation_m": 0.007224674181694773, - "reverse_rotation_deg": 0.10395594559619498, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 6, - "j": 9, - "heldout_inlier_ratio": 0.6009202835468226, - "heldout_inlier_rmse_m": 0.1259448851291812, - "rotation_invariant_error_deg": 0.05639462113465754, - "reverse_translation_m": 0.007975110549369148, - "reverse_rotation_deg": 0.07338758946554978, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 6, - "j": 11, - "heldout_inlier_ratio": 0.4633337584491774, - "heldout_inlier_rmse_m": 0.13769942152040132, - "rotation_invariant_error_deg": 0.1728067345440536, - "reverse_translation_m": 0.023339879627157865, - "reverse_rotation_deg": 0.18888808553225306, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 7, - "j": 8, - "heldout_inlier_ratio": 0.8340050377833753, - "heldout_inlier_rmse_m": 0.11132245152738919, - "rotation_invariant_error_deg": 0.29988500336834534, - "reverse_translation_m": 0.004806949653405585, - "reverse_rotation_deg": 0.02034039865601464, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 7, - "j": 10, - "heldout_inlier_ratio": 0.5721183607775164, - "heldout_inlier_rmse_m": 0.13040415535689726, - "rotation_invariant_error_deg": 0.08655962387919658, - "reverse_translation_m": 0.010507785715791607, - "reverse_rotation_deg": 0.10324111221368969, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 7, - "j": 11, - "heldout_inlier_ratio": 0.5179098728976762, - "heldout_inlier_rmse_m": 0.13593896500168, - "rotation_invariant_error_deg": 0.13200757992937895, - "reverse_translation_m": 0.01570096854689765, - "reverse_rotation_deg": 0.062213006599939585, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 7, - "j": 12, - "heldout_inlier_ratio": 0.419173636250156, - "heldout_inlier_rmse_m": 0.14753718360891266, - "rotation_invariant_error_deg": 0.32523167108959683, - "reverse_translation_m": 0.018245717875293024, - "reverse_rotation_deg": 0.41212759156893974, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 8, - "j": 9, - "heldout_inlier_ratio": 0.6407549981373402, - "heldout_inlier_rmse_m": 0.12189583104066963, - "rotation_invariant_error_deg": 0.5591379691557652, - "reverse_translation_m": 0.025170709673794655, - "reverse_rotation_deg": 0.14112050756711447, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 10, - "heldout_inlier_ratio": 0.6075420709986488, - "heldout_inlier_rmse_m": 0.12933255373443525, - "rotation_invariant_error_deg": 0.23729576277547437, - "reverse_translation_m": 0.01256038832173067, - "reverse_rotation_deg": 0.12386976869589704, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 8, - "j": 11, - "heldout_inlier_ratio": 0.5447599643448364, - "heldout_inlier_rmse_m": 0.13547919137380177, - "rotation_invariant_error_deg": 0.17379413214714745, - "reverse_translation_m": 0.006462771421800638, - "reverse_rotation_deg": 0.08629803406158434, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 8, - "j": 12, - "heldout_inlier_ratio": 0.46489164086687307, - "heldout_inlier_rmse_m": 0.14530908872417966, - "rotation_invariant_error_deg": 0.005046088527275394, - "reverse_translation_m": 0.00955628888567663, - "reverse_rotation_deg": 0.1112688142308669, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 8, - "j": 13, - "heldout_inlier_ratio": 0.37832991803278687, - "heldout_inlier_rmse_m": 0.15442802982944018, - "rotation_invariant_error_deg": 0.9703135322547958, - "reverse_translation_m": 0.027875630486669568, - "reverse_rotation_deg": 0.37387837894914167, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 9, - "j": 10, - "heldout_inlier_ratio": 0.6576312576312576, - "heldout_inlier_rmse_m": 0.10693844153477818, - "rotation_invariant_error_deg": 0.1623946911071812, - "reverse_translation_m": 0.0038184479242649575, - "reverse_rotation_deg": 0.016135929192430513, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 11, - "heldout_inlier_ratio": 0.5883320678309288, - "heldout_inlier_rmse_m": 0.11815838246331245, - "rotation_invariant_error_deg": 0.23697209395887597, - "reverse_translation_m": 0.008866435423074387, - "reverse_rotation_deg": 0.05039949658393549, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 12, - "heldout_inlier_ratio": 0.5413589364844904, - "heldout_inlier_rmse_m": 0.12469816852157387, - "rotation_invariant_error_deg": 0.4899758873523652, - "reverse_translation_m": 0.03403608365914784, - "reverse_rotation_deg": 0.249719392637206, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 9, - "j": 13, - "heldout_inlier_ratio": 0.5075728649611811, - "heldout_inlier_rmse_m": 0.13356609480985904, - "rotation_invariant_error_deg": 0.6957641312376879, - "reverse_translation_m": 0.0053243668825205025, - "reverse_rotation_deg": 0.1401976908512776, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 9, - "j": 14, - "heldout_inlier_ratio": 0.5416463116756228, - "heldout_inlier_rmse_m": 0.12859551377809317, - "rotation_invariant_error_deg": 1.2299678316647693, - "reverse_translation_m": 0.011377143482081005, - "reverse_rotation_deg": 0.045883349808202654, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 11, - "heldout_inlier_ratio": 0.7131414267834794, - "heldout_inlier_rmse_m": 0.12095106901516857, - "rotation_invariant_error_deg": 0.021248756295914717, - "reverse_translation_m": 0.006897671932212844, - "reverse_rotation_deg": 0.18540056788520093, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 10, - "j": 12, - "heldout_inlier_ratio": 0.6117876278616659, - "heldout_inlier_rmse_m": 0.125002241212049, - "rotation_invariant_error_deg": 0.22627625875818325, - "reverse_translation_m": 0.006509808900811586, - "reverse_rotation_deg": 0.06742381610992963, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 10, - "j": 13, - "heldout_inlier_ratio": 0.5244808055380743, - "heldout_inlier_rmse_m": 0.13689263771908436, - "rotation_invariant_error_deg": 0.7458516771815198, - "reverse_translation_m": 0.0046518429660042555, - "reverse_rotation_deg": 0.17931102925270673, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 10, - "j": 14, - "heldout_inlier_ratio": 0.5996858385693572, - "heldout_inlier_rmse_m": 0.12955691635611957, - "rotation_invariant_error_deg": 0.9907110909418435, - "reverse_translation_m": 0.009593578345611205, - "reverse_rotation_deg": 0.05753783232412823, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 10, - "j": 15, - "heldout_inlier_ratio": 0.5048970366649924, - "heldout_inlier_rmse_m": 0.13966622273060364, - "rotation_invariant_error_deg": 0.081650080653759, - "reverse_translation_m": 0.006074999657630774, - "reverse_rotation_deg": 0.04867559411570644, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 11, - "j": 12, - "heldout_inlier_ratio": 0.6508076728924785, - "heldout_inlier_rmse_m": 0.12017753597340274, - "rotation_invariant_error_deg": 0.15490315710383484, - "reverse_translation_m": 0.016302173123952383, - "reverse_rotation_deg": 0.05141023051579345, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 11, - "j": 13, - "heldout_inlier_ratio": 0.5666710199817161, - "heldout_inlier_rmse_m": 0.12966061077144844, - "rotation_invariant_error_deg": 0.8179501999281982, - "reverse_translation_m": 0.010250004424021303, - "reverse_rotation_deg": 0.0630753341579125, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 14, - "heldout_inlier_ratio": 0.64271407110666, - "heldout_inlier_rmse_m": 0.12109534664165014, - "rotation_invariant_error_deg": 0.9336352575787963, - "reverse_translation_m": 0.007610676428698485, - "reverse_rotation_deg": 0.05350102444543152, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 11, - "j": 15, - "heldout_inlier_ratio": 0.570479416362689, - "heldout_inlier_rmse_m": 0.12836105648377344, - "rotation_invariant_error_deg": 0.1445113329869585, - "reverse_translation_m": 0.006898635416764969, - "reverse_rotation_deg": 0.028532809525243653, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 12, - "j": 13, - "heldout_inlier_ratio": 0.7056733087955325, - "heldout_inlier_rmse_m": 0.11689859246507509, - "rotation_invariant_error_deg": 0.9871558772766136, - "reverse_translation_m": 0.0020816591744367207, - "reverse_rotation_deg": 0.08889045467662131, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 12, - "j": 14, - "heldout_inlier_ratio": 0.8745432399512789, - "heldout_inlier_rmse_m": 0.09766069029332589, - "rotation_invariant_error_deg": 0.620973962532374, - "reverse_translation_m": 0.002473515580842477, - "reverse_rotation_deg": 0.018069288085025077, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 15, - "heldout_inlier_ratio": 0.7033426183844012, - "heldout_inlier_rmse_m": 0.12103901189560114, - "rotation_invariant_error_deg": 0.3460892559833546, - "reverse_translation_m": 0.022780233796594867, - "reverse_rotation_deg": 0.04927694758545139, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 12, - "j": 16, - "heldout_inlier_ratio": 0.5820235756385069, - "heldout_inlier_rmse_m": 0.12458133956199553, - "rotation_invariant_error_deg": 0.5019661911966722, - "reverse_translation_m": 0.00989839849833309, - "reverse_rotation_deg": 0.03808519306435704, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 12, - "j": 17, - "heldout_inlier_ratio": 0.6542219994988725, - "heldout_inlier_rmse_m": 0.12658997093251892, - "rotation_invariant_error_deg": 0.4304077591727584, - "reverse_translation_m": 0.019742680150836883, - "reverse_rotation_deg": 0.07899236042083516, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 13, - "j": 14, - "heldout_inlier_ratio": 0.6984766461034874, - "heldout_inlier_rmse_m": 0.11406275231178287, - "rotation_invariant_error_deg": 1.7580702955468261, - "reverse_translation_m": 0.012533581961738958, - "reverse_rotation_deg": 0.10861604448395465, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 13, - "j": 15, - "heldout_inlier_ratio": 0.8794391298650243, - "heldout_inlier_rmse_m": 0.09903209123829654, - "rotation_invariant_error_deg": 0.647826919954289, - "reverse_translation_m": 0.006638809913641406, - "reverse_rotation_deg": 0.04266354358349458, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 16, - "heldout_inlier_ratio": 0.7273073505141552, - "heldout_inlier_rmse_m": 0.10958532316684438, - "rotation_invariant_error_deg": 0.4561367476009117, - "reverse_translation_m": 0.005441055528592516, - "reverse_rotation_deg": 0.12519365495730794, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 17, - "heldout_inlier_ratio": 0.7130265716137395, - "heldout_inlier_rmse_m": 0.11779895987026284, - "rotation_invariant_error_deg": 0.5739060705989409, - "reverse_translation_m": 0.013263327701592687, - "reverse_rotation_deg": 0.16221305155705806, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 13, - "j": 18, - "heldout_inlier_ratio": 0.7019876443728176, - "heldout_inlier_rmse_m": 0.11940768524727291, - "rotation_invariant_error_deg": 0.3921371405111702, - "reverse_translation_m": 0.008995185113784413, - "reverse_rotation_deg": 0.05198334813202341, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 14, - "j": 15, - "heldout_inlier_ratio": 0.7035920622959055, - "heldout_inlier_rmse_m": 0.12189498753760801, - "rotation_invariant_error_deg": 1.1081018436781882, - "reverse_translation_m": 0.010817230757509965, - "reverse_rotation_deg": 0.008099442158890762, - "accepted": false, - "rejection_reasons": [ - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 16, - "heldout_inlier_ratio": 0.5923489278752436, - "heldout_inlier_rmse_m": 0.12241126089476961, - "rotation_invariant_error_deg": 1.2462518921009789, - "reverse_translation_m": 0.003104373432332903, - "reverse_rotation_deg": 0.13386003286196627, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 17, - "heldout_inlier_ratio": 0.6687795177728063, - "heldout_inlier_rmse_m": 0.12452036369759786, - "rotation_invariant_error_deg": 0.467014814888927, - "reverse_translation_m": 0.01159286549234958, - "reverse_rotation_deg": 0.10132041390926738, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 14, - "j": 18, - "heldout_inlier_ratio": 0.6196476790536196, - "heldout_inlier_rmse_m": 0.12845393182350578, - "rotation_invariant_error_deg": 1.3569617298117045, - "reverse_translation_m": 0.010070495463159433, - "reverse_rotation_deg": 0.13041926369959572, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 14, - "j": 19, - "heldout_inlier_ratio": 0.5845660749506904, - "heldout_inlier_rmse_m": 0.12584132662356784, - "rotation_invariant_error_deg": 0.8859663897253398, - "reverse_translation_m": 0.016830803029542436, - "reverse_rotation_deg": 0.2574761671757917, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 15, - "j": 16, - "heldout_inlier_ratio": 0.7032674772036475, - "heldout_inlier_rmse_m": 0.11602216892855616, - "rotation_invariant_error_deg": 0.1669178677739822, - "reverse_translation_m": 0.0009988867448423883, - "reverse_rotation_deg": 0.09036168134112703, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 17, - "heldout_inlier_ratio": 0.7489009568140678, - "heldout_inlier_rmse_m": 0.11923375870790391, - "rotation_invariant_error_deg": 0.057170209113280634, - "reverse_translation_m": 0.02582458487951314, - "reverse_rotation_deg": 0.095039680889365, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 18, - "heldout_inlier_ratio": 0.7165438713998661, - "heldout_inlier_rmse_m": 0.11783922962071142, - "rotation_invariant_error_deg": 0.25175135833068873, - "reverse_translation_m": 0.009354386824208725, - "reverse_rotation_deg": 0.17478401338848865, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 15, - "j": 19, - "heldout_inlier_ratio": 0.6924358974358974, - "heldout_inlier_rmse_m": 0.11506895717743916, - "rotation_invariant_error_deg": 0.19972369514621846, - "reverse_translation_m": 0.012497900854287812, - "reverse_rotation_deg": 0.3255615001296644, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 15, - "j": 20, - "heldout_inlier_ratio": 0.6751867872591427, - "heldout_inlier_rmse_m": 0.11901811643083532, - "rotation_invariant_error_deg": 0.2634006516838383, - "reverse_translation_m": 0.007126007329084919, - "reverse_rotation_deg": 0.09473387178666172, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 17, - "heldout_inlier_ratio": 0.6284461152882206, - "heldout_inlier_rmse_m": 0.1113618900510703, - "rotation_invariant_error_deg": 0.050199814183493174, - "reverse_translation_m": 0.015370940622322818, - "reverse_rotation_deg": 0.07520125332617648, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 18, - "heldout_inlier_ratio": 0.6921281286473868, - "heldout_inlier_rmse_m": 0.10919235768364483, - "rotation_invariant_error_deg": 0.05584922837721962, - "reverse_translation_m": 0.005355462743716769, - "reverse_rotation_deg": 0.03654303027439279, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 19, - "heldout_inlier_ratio": 0.8880188913745961, - "heldout_inlier_rmse_m": 0.0968346861370537, - "rotation_invariant_error_deg": 0.31232814527146147, - "reverse_translation_m": 0.006745004702225108, - "reverse_rotation_deg": 0.04851926363283949, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 16, - "j": 20, - "heldout_inlier_ratio": 0.6307301587301587, - "heldout_inlier_rmse_m": 0.12362874516637085, - "rotation_invariant_error_deg": 0.3556133549145386, - "reverse_translation_m": 0.007128919591300971, - "reverse_rotation_deg": 0.10475436005961275, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 16, - "j": 21, - "heldout_inlier_ratio": 0.40465918895599656, - "heldout_inlier_rmse_m": 0.14174574821871383, - "rotation_invariant_error_deg": 0.03358953741235382, - "reverse_translation_m": 0.01442382622115287, - "reverse_rotation_deg": 0.2621394134233604, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 17, - "j": 18, - "heldout_inlier_ratio": 0.7665916015366274, - "heldout_inlier_rmse_m": 0.11462276561713726, - "rotation_invariant_error_deg": 0.21681649114105994, - "reverse_translation_m": 0.003676908482849856, - "reverse_rotation_deg": 0.03455537183665902, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 17, - "j": 19, - "heldout_inlier_ratio": 0.645738203957382, - "heldout_inlier_rmse_m": 0.11467441399973681, - "rotation_invariant_error_deg": 0.2814841354799569, - "reverse_translation_m": 0.002658154417044598, - "reverse_rotation_deg": 0.03997293849541112, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 17, - "j": 22, - "heldout_inlier_ratio": 0.4255952380952381, - "heldout_inlier_rmse_m": 0.1417851723285674, - "rotation_invariant_error_deg": 0.22747387845950584, - "reverse_translation_m": 0.01638337185583796, - "reverse_rotation_deg": 0.14112774930143776, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 18, - "j": 19, - "heldout_inlier_ratio": 0.6999343401181878, - "heldout_inlier_rmse_m": 0.10876407223187468, - "rotation_invariant_error_deg": 0.45829922568626813, - "reverse_translation_m": 0.0029722527816906422, - "reverse_rotation_deg": 0.028553700929610463, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 18, - "j": 21, - "heldout_inlier_ratio": 0.42345743296016664, - "heldout_inlier_rmse_m": 0.14463219993853524, - "rotation_invariant_error_deg": 0.16988761977478362, - "reverse_translation_m": 0.008594432490503082, - "reverse_rotation_deg": 0.044791316017877565, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 18, - "j": 22, - "heldout_inlier_ratio": 0.35586914688903143, - "heldout_inlier_rmse_m": 0.14801012931814386, - "rotation_invariant_error_deg": 0.0083973626127829, - "reverse_translation_m": 0.05364920712348454, - "reverse_rotation_deg": 0.15560820359743163, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "forward_reverse_translation" - ] - }, - { - "i": 18, - "j": 23, - "heldout_inlier_ratio": 0.3967277486910995, - "heldout_inlier_rmse_m": 0.14073241205403209, - "rotation_invariant_error_deg": 0.0959216601540902, - "reverse_translation_m": 0.0379980141073483, - "reverse_rotation_deg": 0.09667096210106078, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 19, - "j": 20, - "heldout_inlier_ratio": 0.6260444787247719, - "heldout_inlier_rmse_m": 0.12668491637849374, - "rotation_invariant_error_deg": 0.04635374526874614, - "reverse_translation_m": 0.022781715838261912, - "reverse_rotation_deg": 0.19834674514582162, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 19, - "j": 21, - "heldout_inlier_ratio": 0.3952850193339154, - "heldout_inlier_rmse_m": 0.1421446220617431, - "rotation_invariant_error_deg": 0.2944575756539365, - "reverse_translation_m": 0.01796074748252817, - "reverse_rotation_deg": 0.16263425635632095, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 19, - "j": 23, - "heldout_inlier_ratio": 0.37768025078369905, - "heldout_inlier_rmse_m": 0.1432975121556299, - "rotation_invariant_error_deg": 0.34115847207587535, - "reverse_translation_m": 0.07411982241929344, - "reverse_rotation_deg": 0.4458370864472602, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse", - "forward_reverse_translation" - ] - }, - { - "i": 20, - "j": 21, - "heldout_inlier_ratio": 0.6607188376242672, - "heldout_inlier_rmse_m": 0.12214671257866079, - "rotation_invariant_error_deg": 0.3384536988680722, - "reverse_translation_m": 0.01471691635641488, - "reverse_rotation_deg": 0.0747935794181239, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 22, - "heldout_inlier_ratio": 0.576328684508104, - "heldout_inlier_rmse_m": 0.13245799460807672, - "rotation_invariant_error_deg": 0.5030331090558136, - "reverse_translation_m": 0.02165175771302933, - "reverse_rotation_deg": 0.4612076789897289, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "heldout_rmse" - ] - }, - { - "i": 20, - "j": 23, - "heldout_inlier_ratio": 0.6451819579702717, - "heldout_inlier_rmse_m": 0.12102263178677423, - "rotation_invariant_error_deg": 0.411936083868369, - "reverse_translation_m": 0.018249896901851893, - "reverse_rotation_deg": 0.12115759970382113, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 20, - "j": 24, - "heldout_inlier_ratio": 0.7383177570093458, - "heldout_inlier_rmse_m": 0.11441422046802802, - "rotation_invariant_error_deg": 0.19247038033003605, - "reverse_translation_m": 0.009011279667019194, - "reverse_rotation_deg": 0.06430292411421322, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 20, - "j": 25, - "heldout_inlier_ratio": 0.6182822702159718, - "heldout_inlier_rmse_m": 0.12791257682460647, - "rotation_invariant_error_deg": 0.06528383884484867, - "reverse_translation_m": 0.014703530260578728, - "reverse_rotation_deg": 0.32055535743282454, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 21, - "j": 22, - "heldout_inlier_ratio": 0.7740636818348177, - "heldout_inlier_rmse_m": 0.11564788773425824, - "rotation_invariant_error_deg": 0.19149133208546854, - "reverse_translation_m": 0.0065184199045192235, - "reverse_rotation_deg": 0.06991965908247275, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 23, - "heldout_inlier_ratio": 0.862223327530465, - "heldout_inlier_rmse_m": 0.10307116830776755, - "rotation_invariant_error_deg": 0.07804739919204096, - "reverse_translation_m": 0.0026785916987678697, - "reverse_rotation_deg": 0.01879221122979615, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 24, - "heldout_inlier_ratio": 0.7795265676152102, - "heldout_inlier_rmse_m": 0.11182158240581822, - "rotation_invariant_error_deg": 0.5019012138072654, - "reverse_translation_m": 0.003491995501356654, - "reverse_rotation_deg": 0.0374256510953578, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 25, - "heldout_inlier_ratio": 0.7340892465252378, - "heldout_inlier_rmse_m": 0.12002239056891174, - "rotation_invariant_error_deg": 0.07617121764253554, - "reverse_translation_m": 0.037735058311297705, - "reverse_rotation_deg": 0.2878144229712423, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 21, - "j": 26, - "heldout_inlier_ratio": 0.7147358216190014, - "heldout_inlier_rmse_m": 0.11997311573294966, - "rotation_invariant_error_deg": 0.12059196585362031, - "reverse_translation_m": 0.012351932089198563, - "reverse_rotation_deg": 0.10379217190868555, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 23, - "heldout_inlier_ratio": 0.7408951563458002, - "heldout_inlier_rmse_m": 0.11726725109752717, - "rotation_invariant_error_deg": 0.06785708786322786, - "reverse_translation_m": 0.009206244303295173, - "reverse_rotation_deg": 0.09601986001481369, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 24, - "heldout_inlier_ratio": 0.6936064556176288, - "heldout_inlier_rmse_m": 0.11914624513148218, - "rotation_invariant_error_deg": 0.6464246277119301, - "reverse_translation_m": 0.006090737153726605, - "reverse_rotation_deg": 0.027557138417491776, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 22, - "j": 25, - "heldout_inlier_ratio": 0.7356584485868911, - "heldout_inlier_rmse_m": 0.11474070552638106, - "rotation_invariant_error_deg": 0.09992812876472001, - "reverse_translation_m": 0.0019617091597581428, - "reverse_rotation_deg": 0.011643770804738128, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 26, - "heldout_inlier_ratio": 0.7422594142259414, - "heldout_inlier_rmse_m": 0.11765221626900083, - "rotation_invariant_error_deg": 0.28585419533642664, - "reverse_translation_m": 0.007814937371704293, - "reverse_rotation_deg": 0.039342553564881436, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 22, - "j": 27, - "heldout_inlier_ratio": 0.7254925373134329, - "heldout_inlier_rmse_m": 0.11870181965154768, - "rotation_invariant_error_deg": 0.17656741069011161, - "reverse_translation_m": 0.018241823604788005, - "reverse_rotation_deg": 0.08279236858582419, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 24, - "heldout_inlier_ratio": 0.7884810126582279, - "heldout_inlier_rmse_m": 0.10662565692629543, - "rotation_invariant_error_deg": 0.5489092886683267, - "reverse_translation_m": 0.001882338148224756, - "reverse_rotation_deg": 0.020239211377623818, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 23, - "j": 25, - "heldout_inlier_ratio": 0.6843137254901961, - "heldout_inlier_rmse_m": 0.12171091934898426, - "rotation_invariant_error_deg": 2.3712361046355532, - "reverse_translation_m": 0.014639828785635214, - "reverse_rotation_deg": 0.2046006298281892, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 23, - "j": 26, - "heldout_inlier_ratio": 0.6772228989037758, - "heldout_inlier_rmse_m": 0.12237954766026346, - "rotation_invariant_error_deg": 0.10596476474727012, - "reverse_translation_m": 0.04518647006837157, - "reverse_rotation_deg": 0.20367965681897066, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 23, - "j": 28, - "heldout_inlier_ratio": 0.6720351390922401, - "heldout_inlier_rmse_m": 0.12122778564083748, - "rotation_invariant_error_deg": 0.024721954756984132, - "reverse_translation_m": 0.043540468687755365, - "reverse_rotation_deg": 0.26051478047218213, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 25, - "heldout_inlier_ratio": 0.6764267990074442, - "heldout_inlier_rmse_m": 0.12367636388755719, - "rotation_invariant_error_deg": 0.08555695772261629, - "reverse_translation_m": 0.035816405766439664, - "reverse_rotation_deg": 0.2046504337319023, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 24, - "j": 26, - "heldout_inlier_ratio": 0.6524044389642417, - "heldout_inlier_rmse_m": 0.12740232296321938, - "rotation_invariant_error_deg": 0.9096080994730613, - "reverse_translation_m": 0.062038641373543625, - "reverse_rotation_deg": 0.12012273822228971, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant", - "forward_reverse_translation" - ] - }, - { - "i": 24, - "j": 27, - "heldout_inlier_ratio": 0.6546798029556651, - "heldout_inlier_rmse_m": 0.12425657449629145, - "rotation_invariant_error_deg": 0.5645992249410092, - "reverse_translation_m": 0.05403266260962086, - "reverse_rotation_deg": 0.2126374478532415, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "forward_reverse_translation" - ] - }, - { - "i": 24, - "j": 28, - "heldout_inlier_ratio": 0.6614377470355731, - "heldout_inlier_rmse_m": 0.12010155595807545, - "rotation_invariant_error_deg": 0.5530413756685206, - "reverse_translation_m": 0.049490676797893776, - "reverse_rotation_deg": 0.25138526875505346, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 25, - "j": 26, - "heldout_inlier_ratio": 0.9137395459976105, - "heldout_inlier_rmse_m": 0.08148336624555251, - "rotation_invariant_error_deg": 0.0541320112416841, - "reverse_translation_m": 0.0032405549728505064, - "reverse_rotation_deg": 0.006669174585592186, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 27, - "heldout_inlier_ratio": 0.8596658711217183, - "heldout_inlier_rmse_m": 0.1096145882030974, - "rotation_invariant_error_deg": 0.25072546657183636, - "reverse_translation_m": 0.010624789877375215, - "reverse_rotation_deg": 0.04475651255674721, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 28, - "heldout_inlier_ratio": 0.8839157491622786, - "heldout_inlier_rmse_m": 0.10490699814192792, - "rotation_invariant_error_deg": 0.32277369370386566, - "reverse_translation_m": 0.00283419137499405, - "reverse_rotation_deg": 0.01585308444597649, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 25, - "j": 29, - "heldout_inlier_ratio": 0.7857227558401518, - "heldout_inlier_rmse_m": 0.10954358768244267, - "rotation_invariant_error_deg": 0.6270920954002293, - "reverse_translation_m": 0.003247718742817276, - "reverse_rotation_deg": 0.01654235380830592, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 27, - "heldout_inlier_ratio": 0.9188612099644128, - "heldout_inlier_rmse_m": 0.07520973241900301, - "rotation_invariant_error_deg": 0.1438602933497286, - "reverse_translation_m": 0.0009920873307779914, - "reverse_rotation_deg": 0.005485007138529723, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 28, - "heldout_inlier_ratio": 0.9182726623840114, - "heldout_inlier_rmse_m": 0.07611768518866212, - "rotation_invariant_error_deg": 0.19922486670869688, - "reverse_translation_m": 0.004984978187527545, - "reverse_rotation_deg": 0.01173507098896779, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 29, - "heldout_inlier_ratio": 0.7856890251090416, - "heldout_inlier_rmse_m": 0.10851393061782179, - "rotation_invariant_error_deg": 0.6529919473114916, - "reverse_translation_m": 0.002586732426991948, - "reverse_rotation_deg": 0.12205883610743135, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 26, - "j": 30, - "heldout_inlier_ratio": 0.7634835395750642, - "heldout_inlier_rmse_m": 0.10495724850674527, - "rotation_invariant_error_deg": 0.569430013626743, - "reverse_translation_m": 0.008489213184554775, - "reverse_rotation_deg": 0.021733210949123293, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 28, - "heldout_inlier_ratio": 0.9281131178707225, - "heldout_inlier_rmse_m": 0.07220943509634768, - "rotation_invariant_error_deg": 0.05879872494934091, - "reverse_translation_m": 0.0023003913248606234, - "reverse_rotation_deg": 0.001591751329336308, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 29, - "heldout_inlier_ratio": 0.7871188037207112, - "heldout_inlier_rmse_m": 0.10966659884725236, - "rotation_invariant_error_deg": 0.5032080902871385, - "reverse_translation_m": 0.005134403698947268, - "reverse_rotation_deg": 0.02434844099203523, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 31, - "heldout_inlier_ratio": 0.7592097617664149, - "heldout_inlier_rmse_m": 0.10539218018667602, - "rotation_invariant_error_deg": 0.17905197421629282, - "reverse_translation_m": 0.0020939062619997405, - "reverse_rotation_deg": 0.027400662783563425, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 27, - "j": 32, - "heldout_inlier_ratio": 0.7480278422273782, - "heldout_inlier_rmse_m": 0.10408734715846867, - "rotation_invariant_error_deg": 0.2846642642130064, - "reverse_translation_m": 0.004407463145306061, - "reverse_rotation_deg": 0.03490543724836902, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 29, - "heldout_inlier_ratio": 0.787814381863266, - "heldout_inlier_rmse_m": 0.10901449493832843, - "rotation_invariant_error_deg": 0.3245590784482886, - "reverse_translation_m": 0.01570175790237609, - "reverse_rotation_deg": 0.03569660498137675, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 28, - "j": 30, - "heldout_inlier_ratio": 0.7791159962581852, - "heldout_inlier_rmse_m": 0.10438560755009844, - "rotation_invariant_error_deg": 0.40289749313473067, - "reverse_translation_m": 0.01170149615735483, - "reverse_rotation_deg": 0.047047156693309715, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 30, - "heldout_inlier_ratio": 0.7320662880982732, - "heldout_inlier_rmse_m": 0.10929719051930432, - "rotation_invariant_error_deg": 0.013598924391089895, - "reverse_translation_m": 0.005463604154015333, - "reverse_rotation_deg": 0.018583483487870766, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 31, - "heldout_inlier_ratio": 0.7254562254562255, - "heldout_inlier_rmse_m": 0.11323336570178015, - "rotation_invariant_error_deg": 0.5964723771181326, - "reverse_translation_m": 0.0050777995851252426, - "reverse_rotation_deg": 0.07265894091769333, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 29, - "j": 32, - "heldout_inlier_ratio": 0.695837657096737, - "heldout_inlier_rmse_m": 0.10999820041072961, - "rotation_invariant_error_deg": 0.7779150860024799, - "reverse_translation_m": 0.011220553177198233, - "reverse_rotation_deg": 0.14599088546526143, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio", - "rotation_conjugacy_invariant" - ] - }, - { - "i": 29, - "j": 33, - "heldout_inlier_ratio": 0.6382698298586149, - "heldout_inlier_rmse_m": 0.11215583949685817, - "rotation_invariant_error_deg": 0.5073524660734563, - "reverse_translation_m": 0.018977478007060265, - "reverse_rotation_deg": 0.05615608666616428, - "accepted": false, - "rejection_reasons": [ - "overlap_ratio" - ] - }, - { - "i": 30, - "j": 31, - "heldout_inlier_ratio": 0.8286237272623269, - "heldout_inlier_rmse_m": 0.0964659694513182, - "rotation_invariant_error_deg": 0.6302983762623384, - "reverse_translation_m": 0.018905314487385798, - "reverse_rotation_deg": 0.08632503464137033, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 30, - "j": 32, - "heldout_inlier_ratio": 0.8065326633165829, - "heldout_inlier_rmse_m": 0.09815063400019142, - "rotation_invariant_error_deg": 0.727984359566662, - "reverse_translation_m": 0.007341509941520892, - "reverse_rotation_deg": 0.023973741904832375, - "accepted": true, - "rejection_reasons": [] - }, - { - "i": 31, - "j": 32, - "heldout_inlier_ratio": 0.8146841206602162, - "heldout_inlier_rmse_m": 0.09914628416022417, - "rotation_invariant_error_deg": 0.11733254397336168, - "reverse_translation_m": 0.06936877058296162, - "reverse_rotation_deg": 0.45703051311645637, - "accepted": false, - "rejection_reasons": [ - "forward_reverse_translation" - ] - }, - { - "i": 31, - "j": 33, - "heldout_inlier_ratio": 0.7551430598250177, - "heldout_inlier_rmse_m": 0.1003246191461096, - "rotation_invariant_error_deg": 0.09234543926339711, - "reverse_translation_m": 0.005559091155811048, - "reverse_rotation_deg": 0.0330053182501105, - "accepted": true, - "rejection_reasons": [] - } - ] -} \ No newline at end of file diff --git a/results/02_data4_calibration/small_gicp/extrinsic.json b/results/02_data4_calibration/small_gicp/extrinsic.json deleted file mode 100644 index 058ca0a..0000000 --- a/results/02_data4_calibration/small_gicp/extrinsic.json +++ /dev/null @@ -1,489 +0,0 @@ -{ - "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.2944883843818025, - -0.0008838118010001346, - 0.7058442435591689 - ], - "rotation_rpy_deg_xyz": [ - -0.7159364624845366, - 1.3526878670674298, - -0.975972089807914 - ], - "quaternion_xyzw": [ - -0.006146489369094902, - 0.011856702812467925, - -0.008442354678834595, - 0.999875175166545 - ], - "matrix_4x4": [ - [ - 0.9995762904917872, - 0.016736847531056993, - 0.02381422728959523, - 1.2944883843818025 - ], - [ - -0.01702835592221438, - 0.9997818946318248, - 0.01209124728823738, - -0.0008838118010001346 - ], - [ - -0.023606663916460907, - -0.01249164125009491, - 0.9996432785337048, - 0.7058442435591689 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ], - "estimation": { - "stations": 34, - "pairs": 57, - "residuals": { - "pairs": 57, - "translation_m": { - "rms": 0.1544348214275169, - "median": 0.0705120546692258, - "p90": 0.2796247931030114, - "p95": 0.38830732511177307, - "max": 0.42173620405868173 - }, - "rotation_deg": { - "rms": 1.6127366820434261, - "median": 0.7802394472449041, - "p90": 2.0427026963913084, - "p95": 4.139878905679253, - "max": 4.927876933555878 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.04921586129986855, - "rotation_deg": 0.7802394472449041 - }, - { - "pair_index": 1, - "translation_m": 0.06022467069161827, - "rotation_deg": 0.8076387678918286 - }, - { - "pair_index": 2, - "translation_m": 0.05733334031955927, - "rotation_deg": 0.3801287351167008 - }, - { - "pair_index": 3, - "translation_m": 0.10178704595686662, - "rotation_deg": 0.23294290596786388 - }, - { - "pair_index": 4, - "translation_m": 0.0950710667744258, - "rotation_deg": 0.8441747973849835 - }, - { - "pair_index": 5, - "translation_m": 0.1482159791451249, - "rotation_deg": 0.681326797444399 - }, - { - "pair_index": 6, - "translation_m": 0.02325894326521952, - "rotation_deg": 0.6033104606942519 - }, - { - "pair_index": 7, - "translation_m": 0.07474087499522525, - "rotation_deg": 0.6507288891948437 - }, - { - "pair_index": 8, - "translation_m": 0.18825515016508942, - "rotation_deg": 0.26486292076967255 - }, - { - "pair_index": 9, - "translation_m": 0.04309283328904936, - "rotation_deg": 0.13788972833567684 - }, - { - "pair_index": 10, - "translation_m": 0.04634466299044426, - "rotation_deg": 0.727856852897771 - }, - { - "pair_index": 11, - "translation_m": 0.043890799917503956, - "rotation_deg": 0.7033085139548623 - }, - { - "pair_index": 12, - "translation_m": 0.06569153273548976, - "rotation_deg": 0.8215251942968772 - }, - { - "pair_index": 13, - "translation_m": 0.05085505830053342, - "rotation_deg": 0.5703942163369722 - }, - { - "pair_index": 14, - "translation_m": 0.08080041374696341, - "rotation_deg": 0.7042489825699358 - }, - { - "pair_index": 15, - "translation_m": 0.028283768727744116, - "rotation_deg": 0.5815552521395532 - }, - { - "pair_index": 16, - "translation_m": 0.034152028863445455, - "rotation_deg": 1.0076363281960339 - }, - { - "pair_index": 17, - "translation_m": 0.10661935094245772, - "rotation_deg": 0.585736616100307 - }, - { - "pair_index": 18, - "translation_m": 0.0705120546692258, - "rotation_deg": 0.8052707169746115 - }, - { - "pair_index": 19, - "translation_m": 0.06442322486081886, - "rotation_deg": 2.1113003980243557 - }, - { - "pair_index": 20, - "translation_m": 0.058531034305082885, - "rotation_deg": 0.5873890947329841 - }, - { - "pair_index": 21, - "translation_m": 0.06915436202628812, - "rotation_deg": 0.4455496836075116 - }, - { - "pair_index": 22, - "translation_m": 0.1484005911609239, - "rotation_deg": 1.9969708953026104 - }, - { - "pair_index": 23, - "translation_m": 0.10429385187976488, - "rotation_deg": 0.12781289285231975 - }, - { - "pair_index": 24, - "translation_m": 0.06859842051942554, - "rotation_deg": 0.3198403871694416 - }, - { - "pair_index": 25, - "translation_m": 0.037990236699121674, - "rotation_deg": 0.631070403868711 - }, - { - "pair_index": 26, - "translation_m": 0.03189885614531801, - "rotation_deg": 0.7541329389301039 - }, - { - "pair_index": 27, - "translation_m": 0.07672961622319935, - "rotation_deg": 1.5806114049925588 - }, - { - "pair_index": 28, - "translation_m": 0.069983101896218, - "rotation_deg": 0.4729689795147634 - }, - { - "pair_index": 29, - "translation_m": 0.016135065100391668, - "rotation_deg": 0.3789407761818106 - }, - { - "pair_index": 30, - "translation_m": 0.07432095926140471, - "rotation_deg": 1.8120862981058055 - }, - { - "pair_index": 31, - "translation_m": 0.17890921343127023, - "rotation_deg": 3.97184190714068 - }, - { - "pair_index": 32, - "translation_m": 0.2459042707502872, - "rotation_deg": 4.617881335971262 - }, - { - "pair_index": 33, - "translation_m": 0.06334407979243162, - "rotation_deg": 0.8238155509065317 - }, - { - "pair_index": 34, - "translation_m": 0.07743513463604834, - "rotation_deg": 4.0203782981062535 - }, - { - "pair_index": 35, - "translation_m": 0.15971289980951447, - "rotation_deg": 4.84466491195667 - }, - { - "pair_index": 36, - "translation_m": 0.13395086756218255, - "rotation_deg": 4.927876933555878 - }, - { - "pair_index": 37, - "translation_m": 0.06599998782040693, - "rotation_deg": 1.9960824610834838 - }, - { - "pair_index": 38, - "translation_m": 0.04503412561992633, - "rotation_deg": 1.279332716204477 - }, - { - "pair_index": 39, - "translation_m": 0.11215573119400024, - "rotation_deg": 0.5578231171630792 - }, - { - "pair_index": 40, - "translation_m": 0.05509905448014895, - "rotation_deg": 0.6608982729619334 - }, - { - "pair_index": 41, - "translation_m": 0.007272665876828039, - "rotation_deg": 1.2124341117031159 - }, - { - "pair_index": 42, - "translation_m": 0.055811383114362484, - "rotation_deg": 0.8153248357421402 - }, - { - "pair_index": 43, - "translation_m": 0.03138324591270751, - "rotation_deg": 1.2136591021205085 - }, - { - "pair_index": 44, - "translation_m": 0.13982233632280833, - "rotation_deg": 1.2089791291543672 - }, - { - "pair_index": 45, - "translation_m": 0.42173620405868173, - "rotation_deg": 1.126390973143559 - }, - { - "pair_index": 46, - "translation_m": 0.027936086071527602, - "rotation_deg": 0.5561027320483051 - }, - { - "pair_index": 47, - "translation_m": 0.08146548874814821, - "rotation_deg": 1.5984131745791201 - }, - { - "pair_index": 48, - "translation_m": 0.40597723810744263, - "rotation_deg": 1.3479854285502366 - }, - { - "pair_index": 49, - "translation_m": 0.3864154920341234, - "rotation_deg": 0.6215042157245596 - }, - { - "pair_index": 50, - "translation_m": 0.18945577362130134, - "rotation_deg": 0.596177211598774 - }, - { - "pair_index": 51, - "translation_m": 0.37813335218979344, - "rotation_deg": 1.0668602650100487 - }, - { - "pair_index": 52, - "translation_m": 0.330205576632098, - "rotation_deg": 0.40979383494055255 - }, - { - "pair_index": 53, - "translation_m": 0.39587465742237204, - "rotation_deg": 0.7934150366951904 - }, - { - "pair_index": 54, - "translation_m": 0.060998991546499626, - "rotation_deg": 0.9224390837063629 - }, - { - "pair_index": 55, - "translation_m": 0.0952510183208545, - "rotation_deg": 0.8616718556937568 - }, - { - "pair_index": 56, - "translation_m": 0.10976329201195999, - "rotation_deg": 0.5415573303416338 - } - ] - } - }, - "ground": { - "planes": 34, - "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.006072210871275005, - 0.0060852661675311025, - 0.005465720025368553 - ], - "rotation_deg": [ - 0.06255688904352227, - 0.06213349734715941, - 0.13055508827073753 - ], - "warning": "conditional local estimate; bootstrap is the primary stability check" - }, - "weighted_jacobian_condition_number": 6.040138286165465, - "solver_multistart": { - "runs": 12, - "candidates_relative_to_best": [ - { - "cost": 324.2098227991519, - "success": true, - "translation_m": 5.570266299009551e-09, - "rotation_deg": 1.4455049406405054e-07 - }, - { - "cost": 324.20982279914983, - "success": true, - "translation_m": 0.0, - "rotation_deg": 0.0 - }, - { - "cost": 324.20982279915165, - "success": true, - "translation_m": 5.216823166795417e-09, - "rotation_deg": 1.973338877475283e-07 - }, - { - "cost": 324.20982279915034, - "success": true, - "translation_m": 1.3901066622882166e-09, - "rotation_deg": 6.335210062786435e-08 - }, - { - "cost": 324.20982279914995, - "success": true, - "translation_m": 3.578733410578741e-10, - "rotation_deg": 6.852733510041159e-09 - }, - { - "cost": 324.20982279914983, - "success": true, - "translation_m": 6.594966941115627e-10, - "rotation_deg": 2.2216701960527812e-08 - }, - { - "cost": 324.20982279914983, - "success": true, - "translation_m": 2.1650538139486925e-09, - "rotation_deg": 3.6255288379996055e-08 - }, - { - "cost": 324.2098227991501, - "success": true, - "translation_m": 1.5027981325208515e-09, - "rotation_deg": 6.326578543393082e-08 - }, - { - "cost": 324.20982279914983, - "success": true, - "translation_m": 6.094320168262204e-10, - "rotation_deg": 1.025130160040861e-08 - }, - { - "cost": 324.2098227991552, - "success": true, - "translation_m": 1.057266183614633e-08, - "rotation_deg": 3.643863231629731e-07 - }, - { - "cost": 324.20982279915063, - "success": true, - "translation_m": 3.9489601150102006e-09, - "rotation_deg": 1.359274031832874e-07 - }, - { - "cost": 324.20982279914983, - "success": true, - "translation_m": 6.276644321676319e-10, - "rotation_deg": 2.14493230752589e-08 - } - ] - }, - "bootstrap": { - "runs": 100, - "order": [ - "x_m", - "y_m", - "z_m", - "roll_deg", - "pitch_deg", - "yaw_deg" - ], - "std": [ - 0.003048001100427371, - 0.0025869752895426976, - 0.0014870952541001317, - 0.09174691854497609, - 0.06502786700039134, - 0.11777557058586356 - ], - "p025": [ - 1.2892012505330883, - -0.0051467048024525786, - 0.7035478241042927, - -0.8634755073850175, - 1.2139289883714506, - -1.173046710195043 - ], - "p975": [ - 1.2997598841406142, - 0.005003259375615847, - 0.7090711194920217, - -0.48035430043405547, - 1.4534667429791082, - -0.7593758945747364 - ] - } -} \ No newline at end of file diff --git a/results/03_comparison/README.md b/results/03_comparison/README.md deleted file mode 100644 index 37f92f4..0000000 --- a/results/03_comparison/README.md +++ /dev/null @@ -1,7 +0,0 @@ -# 跨批比较 - -- `extrinsic_difference.json`:data4 X 相对历史部署 X 的严格 SE(3) 差,约 `1.592 cm / 0.234°`。 -- `old_extrinsic_on_data4.json`:历史部署 X 在 data4 B 上的残差,约 `0.11953 m / 1.24836°`。 -- `data4_extrinsic_on_previous_batch2.json`:data4 X 在历史第二批 B 上的残差,约 `0.07931 m / 0.98926°`。 - -两套 X 的跨批表现接近,而 data4 自身估计残差更高;因此维持历史部署值,data4 只作为候选。 diff --git a/results/03_comparison/data4_extrinsic_on_previous_batch2.json b/results/03_comparison/data4_extrinsic_on_previous_batch2.json deleted file mode 100644 index adacde3..0000000 --- a/results/03_comparison/data4_extrinsic_on_previous_batch2.json +++ /dev/null @@ -1,298 +0,0 @@ -{ - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": true, - "note": "No AX residual was used to select these pairs", - "stations": 38, - "metrics": { - "pairs": 39, - "translation_m": { - "rms": 0.07931219315845621, - "median": 0.0521831021438143, - "p90": 0.1205091988381832, - "p95": 0.14405284012014574, - "max": 0.23166749945892554 - }, - "rotation_deg": { - "rms": 0.9892579681085032, - "median": 0.8987168885592437, - "p90": 1.5241504377222574, - "p95": 1.5453098245907155, - "max": 1.8288069823538258 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.13184857122951013, - "rotation_deg": 0.4578882478759752, - "i": 0, - "j": 2 - }, - { - "pair_index": 1, - "translation_m": 0.11088249231082419, - "rotation_deg": 0.49123829458862667, - "i": 0, - "j": 3 - }, - { - "pair_index": 2, - "translation_m": 0.06122066543511726, - "rotation_deg": 0.46678985990983063, - "i": 1, - "j": 2 - }, - { - "pair_index": 3, - "translation_m": 0.05361370234686629, - "rotation_deg": 0.6513155675962176, - "i": 1, - "j": 3 - }, - { - "pair_index": 4, - "translation_m": 0.023371189257265605, - "rotation_deg": 0.3726639533978929, - "i": 2, - "j": 3 - }, - { - "pair_index": 5, - "translation_m": 0.07839704351948763, - "rotation_deg": 0.9876540671880906, - "i": 2, - "j": 4 - }, - { - "pair_index": 6, - "translation_m": 0.06371505126502003, - "rotation_deg": 0.8674541404693262, - "i": 3, - "j": 4 - }, - { - "pair_index": 7, - "translation_m": 0.09440077842634854, - "rotation_deg": 1.176934949298133, - "i": 3, - "j": 5 - }, - { - "pair_index": 8, - "translation_m": 0.034738581722701674, - "rotation_deg": 0.46221894567574257, - "i": 4, - "j": 5 - }, - { - "pair_index": 9, - "translation_m": 0.1368264467472551, - "rotation_deg": 1.0614354353201445, - "i": 6, - "j": 7 - }, - { - "pair_index": 10, - "translation_m": 0.003100407410401193, - "rotation_deg": 0.6140746474880827, - "i": 7, - "j": 9 - }, - { - "pair_index": 11, - "translation_m": 0.06611151014323934, - "rotation_deg": 0.09617682103039936, - "i": 8, - "j": 9 - }, - { - "pair_index": 12, - "translation_m": 0.11767435574035143, - "rotation_deg": 0.8987168885592437, - "i": 8, - "j": 10 - }, - { - "pair_index": 13, - "translation_m": 0.05534374617362978, - "rotation_deg": 0.9177398533680782, - "i": 9, - "j": 10 - }, - { - "pair_index": 14, - "translation_m": 0.016375449524654653, - "rotation_deg": 1.8288069823538258, - "i": 12, - "j": 14 - }, - { - "pair_index": 15, - "translation_m": 0.23166749945892554, - "rotation_deg": 0.4806436956517463, - "i": 13, - "j": 15 - }, - { - "pair_index": 16, - "translation_m": 0.20909038047616038, - "rotation_deg": 1.1888833539076575, - "i": 14, - "j": 16 - }, - { - "pair_index": 17, - "translation_m": 0.04954727606060992, - "rotation_deg": 0.7479656125581431, - "i": 17, - "j": 18 - }, - { - "pair_index": 18, - "translation_m": 0.0401572454810912, - "rotation_deg": 1.042619605722841, - "i": 18, - "j": 19 - }, - { - "pair_index": 19, - "translation_m": 0.0432861701880587, - "rotation_deg": 0.6965786478374109, - "i": 20, - "j": 21 - }, - { - "pair_index": 20, - "translation_m": 0.010709015812516234, - "rotation_deg": 1.6253345198252291, - "i": 22, - "j": 23 - }, - { - "pair_index": 21, - "translation_m": 0.058199199584633175, - "rotation_deg": 0.36595813742919014, - "i": 22, - "j": 24 - }, - { - "pair_index": 22, - "translation_m": 0.030262860466569532, - "rotation_deg": 1.1081362850905554, - "i": 22, - "j": 25 - }, - { - "pair_index": 23, - "translation_m": 0.04000865510964372, - "rotation_deg": 1.189922759500818, - "i": 23, - "j": 24 - }, - { - "pair_index": 24, - "translation_m": 0.06464346915846221, - "rotation_deg": 0.7699901460922239, - "i": 24, - "j": 25 - }, - { - "pair_index": 25, - "translation_m": 0.0521831021438143, - "rotation_deg": 0.18489023256895315, - "i": 25, - "j": 26 - }, - { - "pair_index": 26, - "translation_m": 0.08267778191372169, - "rotation_deg": 0.9059437837656906, - "i": 25, - "j": 27 - }, - { - "pair_index": 27, - "translation_m": 0.038589920757972004, - "rotation_deg": 0.8404190717226915, - "i": 26, - "j": 27 - }, - { - "pair_index": 28, - "translation_m": 0.05488335734683258, - "rotation_deg": 1.5217701038732556, - "i": 26, - "j": 28 - }, - { - "pair_index": 29, - "translation_m": 0.022562161090077113, - "rotation_deg": 1.5336717731182645, - "i": 26, - "j": 29 - }, - { - "pair_index": 30, - "translation_m": 0.016794927865731942, - "rotation_deg": 1.4945757001638067, - "i": 27, - "j": 30 - }, - { - "pair_index": 31, - "translation_m": 0.08618762377782405, - "rotation_deg": 1.5364181917868804, - "i": 30, - "j": 31 - }, - { - "pair_index": 32, - "translation_m": 0.06980420384374487, - "rotation_deg": 0.7086752430201493, - "i": 30, - "j": 32 - }, - { - "pair_index": 33, - "translation_m": 0.032647030192474995, - "rotation_deg": 1.2921319816631744, - "i": 32, - "j": 33 - }, - { - "pair_index": 34, - "translation_m": 0.0345860258877476, - "rotation_deg": 1.374123371412574, - "i": 32, - "j": 34 - }, - { - "pair_index": 35, - "translation_m": 0.05213790087077668, - "rotation_deg": 0.46701073818826994, - "i": 32, - "j": 35 - }, - { - "pair_index": 36, - "translation_m": 0.023288081661695596, - "rotation_deg": 0.15454273191995999, - "i": 33, - "j": 34 - }, - { - "pair_index": 37, - "translation_m": 0.035256268159629366, - "rotation_deg": 0.9445397555422734, - "i": 33, - "j": 35 - }, - { - "pair_index": 38, - "translation_m": 0.020736197670988343, - "rotation_deg": 1.137619185440334, - "i": 35, - "j": 36 - } - ] - } -} \ No newline at end of file diff --git a/results/03_comparison/extrinsic_difference.json b/results/03_comparison/extrinsic_difference.json deleted file mode 100644 index 5642112..0000000 --- a/results/03_comparison/extrinsic_difference.json +++ /dev/null @@ -1,43 +0,0 @@ -{ - "convention": "delta = inverse(reference) @ candidate", - "reference": "results\\01_previous_two_batches\\final_extrinsic_deployment.json", - "candidate": "results\\02_data4_calibration\\consensus\\extrinsic.json", - "candidate_minus_reference_translation_xyz_m": [ - 0.002616328047628791, - -0.0016393602019739468, - -0.01562078923962118 - ], - "candidate_minus_reference_rpy_xyz_deg": [ - -0.006740470942029009, - 0.1911623881626312, - -0.13523257777677677 - ], - "relative_translation_norm_m": 0.01592299377608647, - "relative_rotation_deg": 0.23416878770707064, - "relative_matrix_4x4": [ - [ - 0.9999916502190469, - 0.0023133957658166954, - 0.003368633583168801, - 0.0029672356800607425 - ], - [ - -0.0023136119190219507, - 0.9999973217800623, - 6.027097638170339e-05, - -0.0013876386622047616 - ], - [ - -0.0033684851306055737, - -6.80641839411564e-05, - 0.999994324321489, - -0.015582416441470737 - ], - [ - 0.0, - 0.0, - 0.0, - 1.0 - ] - ] -} \ No newline at end of file diff --git a/results/03_comparison/old_extrinsic_on_data4.json b/results/03_comparison/old_extrinsic_on_data4.json deleted file mode 100644 index bfe83ca..0000000 --- a/results/03_comparison/old_extrinsic_on_data4.json +++ /dev/null @@ -1,207 +0,0 @@ -{ - "role": "auxiliary check only; first-batch RTK is sparse", - "blind_with_respect_to_X": true, - "note": "No AX residual was used to select these pairs", - "stations": 34, - "metrics": { - "pairs": 26, - "translation_m": { - "rms": 0.11953342461680516, - "median": 0.059870553274397435, - "p90": 0.11852081980116268, - "p95": 0.27001896145006843, - "max": 0.3924432090639719 - }, - "rotation_deg": { - "rms": 1.248363434126574, - "median": 0.7472573318442859, - "p90": 1.7836452528035456, - "p95": 2.0119235382379705, - "max": 4.302962170390954 - }, - "per_pair": [ - { - "pair_index": 0, - "translation_m": 0.05017939301544147, - "rotation_deg": 0.7621142667147064, - "i": 0, - "j": 2 - }, - { - "pair_index": 1, - "translation_m": 0.05476119605552225, - "rotation_deg": 0.39488243852657817, - "i": 2, - "j": 3 - }, - { - "pair_index": 2, - "translation_m": 0.11117501211320562, - "rotation_deg": 0.29330702638456563, - "i": 2, - "j": 5 - }, - { - "pair_index": 3, - "translation_m": 0.06643052326439366, - "rotation_deg": 0.5530967273631149, - "i": 3, - "j": 5 - }, - { - "pair_index": 4, - "translation_m": 0.028182994383263396, - "rotation_deg": 0.5499639343413396, - "i": 5, - "j": 8 - }, - { - "pair_index": 5, - "translation_m": 0.06086463130525318, - "rotation_deg": 0.6985420749542534, - "i": 6, - "j": 7 - }, - { - "pair_index": 6, - "translation_m": 0.020630277131513722, - "rotation_deg": 0.6820744752666614, - "i": 6, - "j": 8 - }, - { - "pair_index": 7, - "translation_m": 0.046848360772821, - "rotation_deg": 0.8723393366986318, - "i": 12, - "j": 14 - }, - { - "pair_index": 8, - "translation_m": 0.05887647524354169, - "rotation_deg": 1.9071782288631753, - "i": 13, - "j": 16 - }, - { - "pair_index": 9, - "translation_m": 0.11661768017132504, - "rotation_deg": 2.046838641362902, - "i": 15, - "j": 16 - }, - { - "pair_index": 10, - "translation_m": 0.06473893802255462, - "rotation_deg": 0.30644679433866145, - "i": 15, - "j": 17 - }, - { - "pair_index": 11, - "translation_m": 0.04963073408543951, - "rotation_deg": 0.33998803648541337, - "i": 15, - "j": 18 - }, - { - "pair_index": 12, - "translation_m": 0.03313618555659487, - "rotation_deg": 0.5283154781000993, - "i": 16, - "j": 19 - }, - { - "pair_index": 13, - "translation_m": 0.0691797699772094, - "rotation_deg": 0.6320358674350408, - "i": 21, - "j": 22 - }, - { - "pair_index": 14, - "translation_m": 0.042364105706927925, - "rotation_deg": 1.660112276743916, - "i": 21, - "j": 24 - }, - { - "pair_index": 15, - "translation_m": 0.07073443988383908, - "rotation_deg": 0.8343384286314613, - "i": 22, - "j": 23 - }, - { - "pair_index": 16, - "translation_m": 0.12042395943100032, - "rotation_deg": 4.302962170390954, - "i": 22, - "j": 25 - }, - { - "pair_index": 17, - "translation_m": 0.05181438442870987, - "rotation_deg": 0.8455629957527, - "i": 25, - "j": 26 - }, - { - "pair_index": 18, - "translation_m": 0.032857670083788, - "rotation_deg": 0.7324003969738653, - "i": 25, - "j": 28 - }, - { - "pair_index": 19, - "translation_m": 0.05285636518357229, - "rotation_deg": 0.4369186254063126, - "i": 26, - "j": 27 - }, - { - "pair_index": 20, - "translation_m": 0.10251045240958172, - "rotation_deg": 1.0529040723274141, - "i": 26, - "j": 29 - }, - { - "pair_index": 21, - "translation_m": 0.023054151271876995, - "rotation_deg": 0.24976946582216739, - "i": 27, - "j": 28 - }, - { - "pair_index": 22, - "translation_m": 0.06593100197822659, - "rotation_deg": 1.2515362824917693, - "i": 27, - "j": 29 - }, - { - "pair_index": 23, - "translation_m": 0.31988396212309117, - "rotation_deg": 1.0256849788735003, - "i": 29, - "j": 30 - }, - { - "pair_index": 24, - "translation_m": 0.3924432090639719, - "rotation_deg": 0.8042671494244682, - "i": 29, - "j": 31 - }, - { - "pair_index": 25, - "translation_m": 0.11357259403662164, - "rotation_deg": 0.901297615800165, - "i": 30, - "j": 32 - } - ] - } -} \ No newline at end of file diff --git a/results/README.md b/results/README.md index 5676a2e..e43ace6 100644 --- a/results/README.md +++ b/results/README.md @@ -1,21 +1,5 @@ -# 结果目录 +# results目录 -本目录只归档轻量标定产物,不包含原始 dlog、rscap、逐帧 NPZ 或完整点云。 +`reference_data4/`是本仓库附带的精简参考结果。新的运行结果应写到仓库外目录或`outputs/`,不要覆盖参考结果。 -| 目录 | 内容 | 使用建议 | -|---|---|---| -| `01_previous_two_batches/` | 第二批求解、第一批辅助复核的历史部署结果;含 Open3D、small_gicp、consensus B、质量和灵敏度文件 | 当前部署基线 | -| `02_data4_calibration/` | data4 的 Open3D、small_gicp、consensus B 和独立 X | 候选/稳定性证据 | -| `03_comparison/` | 两套 X 的 SE(3) 差以及互换批次后的 AX 残差 | 跨批判断依据 | - -最终部署文件是 `01_previous_two_batches/final_extrinsic_deployment.json`。`02_data4_calibration/final_extrinsic_data4.json` 不应在没有新增独立证据时覆盖它。 - -常见文件: - -- `B_*_estimation.npz`:后端原始运动对 B。 -- `B_*_quality.json/csv`:配准和 Hessian/信息矩阵质量。 -- `B_*_refined.npz`:X 无关筛选后的 B。 -- `B_*_consensus.npz` 或 `consensus/B_consensus.npz`:双后端认可的 B。 -- `extrinsic*.json`:由对应 B 和地面约束求出的 X。 -- `*_check.json`:把给定 X 应用于另一批 B 的残差,不是重新求 X。 -- `ground_planes*.csv`:每站地面平面参数。 +参考结果保留最终矩阵、共识B、两后端精筛B、逐对CSV/筛选审计和地面平面;未保留原始点云、逐帧combined数据、冗长的初筛JSON和带本机绝对路径的过程文件。 diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/README.md b/results/reference_data4/README.md similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/README.md rename to results/reference_data4/README.md diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/common/ground_planes.csv b/results/reference_data4/common/ground_planes.csv similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/common/ground_planes.csv rename to results/reference_data4/common/ground_planes.csv diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/B_consensus.consensus.json b/results/reference_data4/consensus/B_consensus.consensus.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/B_consensus.consensus.json rename to results/reference_data4/consensus/B_consensus.consensus.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/B_consensus.npz b/results/reference_data4/consensus/B_consensus.npz similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/B_consensus.npz rename to results/reference_data4/consensus/B_consensus.npz diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/extrinsic_rtk_lidar.json b/results/reference_data4/consensus/extrinsic_rtk_lidar.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/consensus/extrinsic_rtk_lidar.json rename to results/reference_data4/consensus/extrinsic_rtk_lidar.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/final_T_RTK_lidar.json b/results/reference_data4/final_T_RTK_lidar.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/final_T_RTK_lidar.json rename to results/reference_data4/final_T_RTK_lidar.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_quality.csv b/results/reference_data4/open3d_gicp/B_quality.csv similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_quality.csv rename to results/reference_data4/open3d_gicp/B_quality.csv diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_refined.npz b/results/reference_data4/open3d_gicp/B_refined.npz similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_refined.npz rename to results/reference_data4/open3d_gicp/B_refined.npz diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_refined.refinement.json b/results/reference_data4/open3d_gicp/B_refined.refinement.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/B_refined.refinement.json rename to results/reference_data4/open3d_gicp/B_refined.refinement.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/extrinsic_rtk_lidar.json b/results/reference_data4/open3d_gicp/extrinsic_rtk_lidar.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/open3d_gicp/extrinsic_rtk_lidar.json rename to results/reference_data4/open3d_gicp/extrinsic_rtk_lidar.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_quality.csv b/results/reference_data4/small_gicp/B_quality.csv similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_quality.csv rename to results/reference_data4/small_gicp/B_quality.csv diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_refined.npz b/results/reference_data4/small_gicp/B_refined.npz similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_refined.npz rename to results/reference_data4/small_gicp/B_refined.npz diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_refined.refinement.json b/results/reference_data4/small_gicp/B_refined.refinement.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/B_refined.refinement.json rename to results/reference_data4/small_gicp/B_refined.refinement.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/extrinsic_rtk_lidar.json b/results/reference_data4/small_gicp/extrinsic_rtk_lidar.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/small_gicp/extrinsic_rtk_lidar.json rename to results/reference_data4/small_gicp/extrinsic_rtk_lidar.json diff --git a/LiDAR_RTK_Direct_Calibration/results/reference_data4/summary.json b/results/reference_data4/summary.json similarity index 100% rename from LiDAR_RTK_Direct_Calibration/results/reference_data4/summary.json rename to results/reference_data4/summary.json diff --git a/run/README.md b/run/README.md index 4839b69..120bf1c 100644 --- a/run/README.md +++ b/run/README.md @@ -1,27 +1,14 @@ -# run +# run目录 -本目录是 PowerShell 运行入口;完整流程、参数解释、验收方法和代码职责统一见仓库根目录 `README.md`。 +根README包含完整复现命令;这里仅列入口职责。 -| 脚本 | 使用时机 | +| 脚本 | 用途 | |---|---| -| `export_legacy_stations.ps1` | 第一、第二批式逐站 dlog 导出。 | -| `export_multisensor_stations.ps1` | LiDAR dlog + 独立 RTK/IMU rscap 导出和时间关联。 | -| `prepare_legacy_dataset.ps1` | 旧式导出结果生成 prepared。 | -| `prepare_multisensor_dataset.ps1` | 多传感器 combined 结果生成 prepared。 | -| `run_single_dataset.ps1` | 单批数据运行 small_gicp、Open3D、consensus 和 X 求解。 | -| `run_all.ps1` | 第二批求解、第一批辅助复核的历史流程。 | -| `run_consensus_finish.ps1` | 从已有两个后端 B 重做 consensus。 | -| `run_sensitivity_scan.ps1` | 指定 Pair 的外参角度灵敏度扫描。 | -| `view_result.ps1` | 传入 frames、B、X 查看 3D 配准及增量。 | +| `run_full_pipeline.ps1` | 从逐站LiDAR dlog、RTK rscap、IMU rscap一直运行到最终`T_RTK_lidar` | +| `export_multisensor_stations.ps1` | 解析原始三传感器数据并按LiDAR帧生成combined NPZ | +| `prepare_multisensor_dataset.ps1` | 每站选一帧,生成yaw-only RTK参考轨迹和`frames_all` | +| `run_direct_rtk_lidar.ps1` | 从combined数据运行RTK直接标定和最终结果封装 | +| `run_single_dataset.ps1` | 执行地面、两个GICP后端、精筛、共识和AX=XB求解 | +| `view_result.ps1` | 打开3D运动对对比并打印数值增量 | -最常用的 3D 入口: - -```powershell -powershell.exe -NoProfile -ExecutionPolicy Bypass -File ".\run\view_result.ps1" ` - -Frames "D:\你的数据目录\prepared\frames_all" ` - -Pairs "D:\你的结果目录\B_consensus.npz" ` - -Extrinsic "D:\你的结果目录\extrinsic.json" ` - -PairIndex 0 -``` - -`frames_all` 必须与生成 B 时的站点顺序一致。 +所有路径均为命令行参数;默认生成目录`work/`和`outputs/`不会提交Git。 diff --git a/run/export_legacy_stations.ps1 b/run/export_legacy_stations.ps1 deleted file mode 100644 index c577d7f..0000000 --- a/run/export_legacy_stations.ps1 +++ /dev/null @@ -1,34 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$DataRoot, - [Parameter(Mandatory = $true)][string]$OutputRoot, - [string]$LidarObject = "frontlidar", - [string]$Timezone = "+08:00", - [string[]]$StationNames = @(), - [int]$Stride = 1, - [double]$RtkMaxDtMs = 150.0 -) - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -$Exporter = Join-Path $Repo "tools\frontlidar_dlog_export.py" -if (-not (Test-Path -LiteralPath $DataRoot)) { throw "DataRoot does not exist: $DataRoot" } -if ($Stride -lt 1) { throw "Stride must be at least 1" } -if ($StationNames.Count -gt 0) { - $Stations = @($StationNames | ForEach-Object { Get-Item -LiteralPath (Join-Path $DataRoot $_) }) -} else { - $Stations = @(Get-ChildItem -LiteralPath $DataRoot -Directory | Where-Object { - (Test-Path -LiteralPath (Join-Path $_.FullName "dobject")) -and - (Test-Path -LiteralPath (Join-Path $_.FullName "dobject_recording")) - } | Sort-Object Name) -} -if ($Stations.Count -eq 0) { throw "No station directory containing dobject and dobject_recording was found" } -New-Item -ItemType Directory -Force -Path $OutputRoot | Out-Null -foreach ($Station in $Stations) { - $Out = Join-Path $OutputRoot $Station.Name - Write-Host "[legacy station $($Station.Name)]" - & python $Exporter --dlog $Station.FullName --out $Out --object $LidarObject --format npz ` - --timezone $Timezone --stride $Stride --compress --rtk-sidecars --write-reports --resume ` - --rtk-max-dt-ms $RtkMaxDtMs - if ($LASTEXITCODE -ne 0) { throw "Export failed for station $($Station.Name)" } -} -Write-Host "Exported stations: $($Stations.Count)" diff --git a/run/prepare_legacy_dataset.ps1 b/run/prepare_legacy_dataset.ps1 deleted file mode 100644 index 934f8f5..0000000 --- a/run/prepare_legacy_dataset.ps1 +++ /dev/null @@ -1,21 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$ExportRoot, - [Parameter(Mandatory = $true)][string]$Output, - [Parameter(Mandatory = $true)][double]$HeadingOffsetDeg, - [Parameter(Mandatory = $true)][double[]]$AntennaLever, - [int]$MinStations = 30, - [int]$ExpectedStations = 0, - [double]$HeadingStdLimitDeg = [double]::PositiveInfinity, - [switch]$Overwrite -) - -$ErrorActionPreference = "Stop" -if ($AntennaLever.Count -ne 3) { throw "AntennaLever must contain X,Y,Z in body coordinates" } -$Repo = Split-Path -Parent $PSScriptRoot -$Args = @((Join-Path $Repo "tools\prepare_station_dataset.py"), "--export-root", $ExportRoot, - "--output", $Output, "--heading-offset-deg", "$HeadingOffsetDeg", "--antenna-lever") + - @($AntennaLever | ForEach-Object { "$_" }) + @("--min-stations", "$MinStations", - "--expected-stations", "$ExpectedStations", "--heading-std-limit-deg", "$HeadingStdLimitDeg") -if ($Overwrite) { $Args += "--overwrite" } -& python @Args -if ($LASTEXITCODE -ne 0) { throw "Legacy dataset preparation failed" } diff --git a/run/prepare_multisensor_dataset.ps1 b/run/prepare_multisensor_dataset.ps1 index 28c57cf..a5b07a9 100644 --- a/run/prepare_multisensor_dataset.ps1 +++ b/run/prepare_multisensor_dataset.ps1 @@ -3,6 +3,7 @@ param( [Parameter(Mandatory = $true)][string]$Output, [Parameter(Mandatory = $true)][double]$HeadingOffsetDeg, [Parameter(Mandatory = $true)][double[]]$AntennaLever, + [string]$PoseName = "rtk_gga_raw_heading", [int]$MinStations = 30, [int]$ExpectedStations = 0, [double]$HeadingStdLimitDeg = 0.5, @@ -13,7 +14,7 @@ $ErrorActionPreference = "Stop" if ($AntennaLever.Count -ne 3) { throw "AntennaLever must contain X,Y,Z in body coordinates" } $Repo = Split-Path -Parent $PSScriptRoot $Args = @((Join-Path $Repo "tools\prepare_multisensor_station_dataset.py"), "--combined-root", $CombinedRoot, - "--output", $Output, "--heading-offset-deg", "$HeadingOffsetDeg", "--antenna-lever") + + "--output", $Output, "--pose-name", $PoseName, "--heading-offset-deg", "$HeadingOffsetDeg", "--antenna-lever") + @($AntennaLever | ForEach-Object { "$_" }) + @("--min-stations", "$MinStations", "--expected-stations", "$ExpectedStations", "--heading-std-limit-deg", "$HeadingStdLimitDeg") if ($Overwrite) { $Args += "--overwrite" } diff --git a/run/run_all.ps1 b/run/run_all.ps1 deleted file mode 100644 index 18d7ed7..0000000 --- a/run/run_all.ps1 +++ /dev/null @@ -1,74 +0,0 @@ -param( - [Parameter(Mandatory = $true)][string]$Batch1Prepared, - [Parameter(Mandatory = $true)][string]$Batch2Prepared, - [string]$OutputRoot = "" -) - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -if ([string]::IsNullOrWhiteSpace($OutputRoot)) { - $OutputRoot = Join-Path $Repo "results\01_previous_two_batches" -} -$Code = Join-Path $Repo "code\rigorous_calibration.py" -$Refine = Join-Path $Repo "code\refine_pairs.py" -$Summary = Join-Path $Repo "code\summarize_results.py" -$B1Frames = Join-Path $Batch1Prepared "frames_all" -$B2Frames = Join-Path $Batch2Prepared "frames_all" -$B1Body = Join-Path $Batch1Prepared "body_poses_rear_gga_raw_rear_to_front.csv" -$B2Body = Join-Path $Batch2Prepared "body_poses_rear_gga_raw_rear_to_front.csv" - -function Run-Python { - param([string]$Stage, [string[]]$Arguments) - Write-Host "[$Stage]" - & python @Arguments - if ($LASTEXITCODE -ne 0) { throw "$Stage failed with Python exit code $LASTEXITCODE" } -} - -foreach ($Path in @($B1Frames, $B2Frames, $B1Body, $B2Body)) { - if (-not (Test-Path -LiteralPath $Path)) { throw "Input does not exist: $Path" } -} -$Common = Join-Path $OutputRoot "common" -$Small = Join-Path $OutputRoot "small_gicp" -$Open = Join-Path $OutputRoot "open3d_gicp" -New-Item -ItemType Directory -Force -Path $Common,$Small,$Open | Out-Null - -Run-Python "batch2 ground planes" @($Code, "ground", "--frames", $B2Frames, "--output", (Join-Path $Common "ground_planes_batch2.csv")) - -foreach ($Backend in @("small_gicp", "open3d")) { - $Directory = if ($Backend -eq "small_gicp") { $Small } else { $Open } - $Extra = @() - if ($Backend -eq "open3d") { $Extra = @("--max-gap", "3", "--multistart", "1", "--iterations", "40") } - $B2Raw = Join-Path $Directory "B_batch2_estimation.npz" - $B2QualityJson = Join-Path $Directory "B_batch2_quality.json" - $B2QualityCsv = Join-Path $Directory "B_batch2_quality.csv" - Run-Python "$Backend batch2 pairs" (@($Code, "pairs", "--backend", $Backend, "--frames", $B2Frames, "--body", $B2Body, - "--output", $B2Raw, "--quality-json", $B2QualityJson, "--quality-csv", $B2QualityCsv) + $Extra) - $B2Refined = Join-Path $Directory "B_batch2_refined.npz" - Run-Python "$Backend batch2 refinement" @($Refine, "--pairs", $B2Raw, "--quality-json", $B2QualityJson, "--output", $B2Refined) - $Extrinsic = Join-Path $Directory "extrinsic_batch2_refined.json" - Run-Python "$Backend batch2 calibration" @($Code, "calibrate", "--pairs", $B2Refined, - "--ground-planes", (Join-Path $Common "ground_planes_batch2.csv"), "--output", $Extrinsic) - - $B1Raw = Join-Path $Directory "B_batch1_auxiliary.npz" - $B1QualityJson = Join-Path $Directory "B_batch1_quality.json" - $B1QualityCsv = Join-Path $Directory "B_batch1_quality.csv" - Run-Python "$Backend batch1 auxiliary pairs" @($Code, "pairs", "--backend", $Backend, "--frames", $B1Frames, "--body", $B1Body, - "--output", $B1Raw, "--quality-json", $B1QualityJson, "--quality-csv", $B1QualityCsv, - "--max-gap", "3", "--multistart", "1", "--iterations", "40") - $B1Refined = Join-Path $Directory "B_batch1_auxiliary_refined.npz" - Run-Python "$Backend batch1 refinement" @($Refine, "--pairs", $B1Raw, "--quality-json", $B1QualityJson, "--output", $B1Refined) - Run-Python "$Backend batch1 auxiliary check" @($Code, "validate", "--pairs", $B1Refined, - "--extrinsic", $Extrinsic, "--output", (Join-Path $Directory "batch1_auxiliary_check.json")) -} - -Run-Python "backend summary" @($Summary, - "--open3d", (Join-Path $Open "extrinsic_batch2_refined.json"), - "--small", (Join-Path $Small "extrinsic_batch2_refined.json"), - "--open3d-quality", (Join-Path $Open "B_batch2_quality.json"), - "--small-quality", (Join-Path $Small "B_batch2_quality.json"), - "--open3d-check", (Join-Path $Open "batch1_auxiliary_check.json"), - "--small-check", (Join-Path $Small "batch1_auxiliary_check.json"), - "--output", (Join-Path $OutputRoot "comparison_summary.json"), - "--recommended-output", (Join-Path $OutputRoot "final_extrinsic_recommended.json")) - -Write-Host "Two-batch results: $OutputRoot" diff --git a/run/run_consensus_finish.ps1 b/run/run_consensus_finish.ps1 deleted file mode 100644 index f809b3d..0000000 --- a/run/run_consensus_finish.ps1 +++ /dev/null @@ -1,34 +0,0 @@ -param([string]$ResultRoot = "") - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -if ([string]::IsNullOrWhiteSpace($ResultRoot)) { $ResultRoot = Join-Path $Repo "results\01_previous_two_batches" } -$Code = Join-Path $Repo "code\rigorous_calibration.py" -$Filter = Join-Path $Repo "code\cross_backend_filter.py" -$Finalize = Join-Path $Repo "code\finalize_consensus.py" - -function Run-Python { - param([string[]]$Arguments) - & python @Arguments - if ($LASTEXITCODE -ne 0) { throw "Python failed with exit code $LASTEXITCODE" } -} - -Run-Python @($Filter, "--open3d-pairs", (Join-Path $ResultRoot "open3d_gicp\B_batch2_refined.npz"), - "--small-pairs", (Join-Path $ResultRoot "small_gicp\B_batch2_refined.npz"), - "--output", (Join-Path $ResultRoot "consensus\B_batch2_consensus.npz")) -Run-Python @($Filter, "--open3d-pairs", (Join-Path $ResultRoot "open3d_gicp\B_batch1_auxiliary_refined.npz"), - "--small-pairs", (Join-Path $ResultRoot "small_gicp\B_batch1_auxiliary_refined.npz"), - "--output", (Join-Path $ResultRoot "consensus\B_batch1_consensus.npz"), "--min-pairs", "15") -Run-Python @($Code, "calibrate", "--pairs", (Join-Path $ResultRoot "consensus\B_batch2_consensus.npz"), - "--ground-planes", (Join-Path $ResultRoot "common\ground_planes_batch2.csv"), - "--output", (Join-Path $ResultRoot "consensus\extrinsic_batch2_consensus.json")) -Run-Python @($Code, "validate", "--pairs", (Join-Path $ResultRoot "consensus\B_batch1_consensus.npz"), - "--extrinsic", (Join-Path $ResultRoot "consensus\extrinsic_batch2_consensus.json"), - "--output", (Join-Path $ResultRoot "consensus\batch1_auxiliary_check.json")) -Run-Python @($Finalize, - "--consensus-extrinsic", (Join-Path $ResultRoot "consensus\extrinsic_batch2_consensus.json"), - "--consensus-check", (Join-Path $ResultRoot "consensus\batch1_auxiliary_check.json"), - "--open3d-extrinsic", (Join-Path $ResultRoot "open3d_gicp\extrinsic_batch2_refined.json"), - "--small-extrinsic", (Join-Path $ResultRoot "small_gicp\extrinsic_batch2_refined.json"), - "--output", (Join-Path $ResultRoot "final_extrinsic_recommended.json"), - "--summary", (Join-Path $ResultRoot "final_summary.json")) diff --git a/LiDAR_RTK_Direct_Calibration/run/run_direct_rtk_lidar.ps1 b/run/run_direct_rtk_lidar.ps1 similarity index 100% rename from LiDAR_RTK_Direct_Calibration/run/run_direct_rtk_lidar.ps1 rename to run/run_direct_rtk_lidar.ps1 diff --git a/LiDAR_RTK_Direct_Calibration/run/run_full_pipeline.ps1 b/run/run_full_pipeline.ps1 similarity index 100% rename from LiDAR_RTK_Direct_Calibration/run/run_full_pipeline.ps1 rename to run/run_full_pipeline.ps1 diff --git a/run/run_sensitivity_scan.ps1 b/run/run_sensitivity_scan.ps1 deleted file mode 100644 index 8c66353..0000000 --- a/run/run_sensitivity_scan.ps1 +++ /dev/null @@ -1,22 +0,0 @@ -param( - [int]$PairIndex = 0, - [string]$ResultRoot = "" -) - -$ErrorActionPreference = "Stop" -$Repo = Split-Path -Parent $PSScriptRoot -if ([string]::IsNullOrWhiteSpace($ResultRoot)) { $ResultRoot = Join-Path $Repo "results\01_previous_two_batches" } -$Code = Join-Path $Repo "code\scan_extrinsic_sensitivity.py" -$X = Join-Path $ResultRoot "final_extrinsic_recommended.json" -$Ground = Join-Path $ResultRoot "common\ground_planes_batch2.csv" -$Out = Join-Path $ResultRoot "diagnostics" - -foreach ($Backend in @("open3d_gicp", "small_gicp")) { - $Label = if ($Backend -eq "open3d_gicp") { "open3d_refined" } else { "small_gicp_refined" } - & python $Code --pairs (Join-Path $ResultRoot "$Backend\B_batch2_refined.npz") --extrinsic $X ` - --ground-planes $Ground --pair-index $PairIndex --output (Join-Path $Out "${Label}_pair${PairIndex}_left_rpy_scan.json") - if ($LASTEXITCODE -ne 0) { throw "$Backend sensitivity scan failed" } -} -& python $Code --pairs (Join-Path $ResultRoot "consensus\B_batch2_consensus.npz") --extrinsic $X ` - --ground-planes $Ground --pair-index $PairIndex --output (Join-Path $Out "consensus_pair${PairIndex}_left_rpy_scan.json") -if ($LASTEXITCODE -ne 0) { throw "Consensus sensitivity scan failed" } diff --git a/run/run_single_dataset.ps1 b/run/run_single_dataset.ps1 index 13b8713..3bf3e53 100644 --- a/run/run_single_dataset.ps1 +++ b/run/run_single_dataset.ps1 @@ -1,8 +1,8 @@ param( [Parameter(Mandatory = $true)][string]$Prepared, [Parameter(Mandatory = $true)][string]$OutputRoot, - [string]$PoseName = "rear_gga_raw_rear_to_front", - [double]$BodyHeight = 0.2335, + [string]$ReferencePoseFile = "reference_poses_rtk_gga_raw_heading.csv", + [double]$ReferenceHeight = 0.8535, [int]$MinPairs = 20, [int]$Bootstrap = 100 ) @@ -13,7 +13,7 @@ $Code = Join-Path $Repo "code\rigorous_calibration.py" $Refine = Join-Path $Repo "code\refine_pairs.py" $Consensus = Join-Path $Repo "code\cross_backend_filter.py" $Frames = Join-Path $Prepared "frames_all" -$Body = Join-Path $Prepared "body_poses_$PoseName.csv" +$ReferencePoses = Join-Path $Prepared $ReferencePoseFile $Common = Join-Path $OutputRoot "common" $Open = Join-Path $OutputRoot "open3d_gicp" $Small = Join-Path $OutputRoot "small_gicp" @@ -26,7 +26,7 @@ function Run-Python { if ($LASTEXITCODE -ne 0) { throw "$Stage failed with Python exit code $LASTEXITCODE" } } -foreach ($Path in @($Frames, $Body)) { +foreach ($Path in @($Frames, $ReferencePoses)) { if (-not (Test-Path -LiteralPath $Path)) { throw "Input does not exist: $Path" } } New-Item -ItemType Directory -Force -Path $Common,$Open,$Small,$ConsensusOut | Out-Null @@ -39,7 +39,7 @@ foreach ($Backend in @("small_gicp", "open3d")) { $Raw = Join-Path $Directory "B_estimation.npz" $QualityJson = Join-Path $Directory "B_quality.json" $QualityCsv = Join-Path $Directory "B_quality.csv" - $PairArgs = @($Code, "pairs", "--backend", $Backend, "--frames", $Frames, "--body", $Body, + $PairArgs = @($Code, "pairs", "--backend", $Backend, "--frames", $Frames, "--reference-poses", $ReferencePoses, "--output", $Raw, "--quality-json", $QualityJson, "--quality-csv", $QualityCsv, "--min-pairs", "$MinPairs") if ($Backend -eq "open3d") { $PairArgs += @("--max-gap", "3", "--multistart", "1", "--iterations", "40") } @@ -50,7 +50,7 @@ foreach ($Backend in @("small_gicp", "open3d")) { ) Run-Python "$Backend calibration" @( $Code, "calibrate", "--pairs", (Join-Path $Directory "B_refined.npz"), - "--ground-planes", $Ground, "--body-height", "$BodyHeight", + "--ground-planes", $Ground, "--reference-height", "$ReferenceHeight", "--bootstrap", "$Bootstrap", "--output", (Join-Path $Directory "extrinsic.json") ) } @@ -63,7 +63,7 @@ Run-Python "cross-backend consensus" @( ) Run-Python "consensus calibration" @( $Code, "calibrate", "--pairs", $ConsensusPairs, "--ground-planes", $Ground, - "--body-height", "$BodyHeight", "--bootstrap", "$Bootstrap", + "--reference-height", "$ReferenceHeight", "--bootstrap", "$Bootstrap", "--output", (Join-Path $ConsensusOut "extrinsic.json") ) diff --git a/tools/README.md b/tools/README.md index 0c56399..c670433 100644 --- a/tools/README.md +++ b/tools/README.md @@ -1,26 +1,11 @@ -# tools +# tools目录 -本目录负责从原始 dlog/rscap 导出 NPZ、关联 RTK/IMU 并生成 prepared;完整流程和参数统一见仓库根目录 `README.md`。 - -| 文件 | 作用 | +| 文件 | 输入→输出 | |---|---| -| `frontlidar_dlog_export.py` | 从单个 Medulla dlog 导出原始 LiDAR NPZ,可匹配站内 RTK。 | -| `prepare_station_dataset.py` | 旧式逐站导出生成 prepared。 | -| `build_multisensor_npz.py` | 以 LiDAR 帧为索引关联独立 RTK/IMU。 | -| `prepare_multisensor_station_dataset.py` | combined NPZ 生成 prepared。 | -| `rscap_v2/capture_format_v2.py` | 读取 rscap v2。 | -| `rscap_v2/audit_capture_v2.py` | 审计 capture 完整性。 | -| `rscap_v2/parse_rtk_imu_v2.py` | 解析 RTK/IMU 为 JSONL。 | -| `rscap_v2/pipeline_common*.py` | 时间和协议解析共用逻辑。 | +| `frontlidar_dlog_export.py` | LiDAR dlog → 逐帧原始点云NPZ;时间来自DObject post tick | +| `rscap_v2/parse_rtk_imu_v2.py` | RTK/IMU rscap → JSONL,保存校验状态、主机时间、GNSS/IMU设备字段和原始报文 | +| `rscap_v2/audit_capture_v2.py` | 检查rscap结构、时间范围和记录统计 | +| `build_multisensor_npz.py` | 按LiDAR帧最近邻关联GGA/heading,并附加IMU时间窗 → combined NPZ | +| `prepare_multisensor_station_dataset.py` | combined NPZ → 每站一帧`frames_all`和`reference_poses_*.csv` | -统一输出接口: - -```text -prepared/ - frames_all/station_*.npz - body_poses_rear_gga_raw_rear_to_front.csv - station_summary.csv - manifest.json -``` - -后续配准必须使用 `points_raw`,不能使用已经由某套外参变换后的点云。 +当前标定只使用LiDAR和RTK;IMU保持原始传感器坐标,不参与点云去畸变或外参求解。prepared阶段对站内有效RTK取平均、对heading取圆均值,并选择有效帧序列的中间LiDAR帧。 diff --git a/tools/prepare_multisensor_station_dataset.py b/tools/prepare_multisensor_station_dataset.py index 0cc3ce1..c47fdc5 100644 --- a/tools/prepare_multisensor_station_dataset.py +++ b/tools/prepare_multisensor_station_dataset.py @@ -1,5 +1,5 @@ #!/usr/bin/env python3 -"""Prepare one static LiDAR frame and one yaw-only RTK body pose per NPZ segment.""" +"""Prepare one static LiDAR frame and one yaw-only RTK reference pose per NPZ segment.""" from __future__ import annotations @@ -66,7 +66,7 @@ def parse_args() -> argparse.Namespace: parser = argparse.ArgumentParser(description=__doc__) parser.add_argument("--combined-root", type=Path, required=True) parser.add_argument("--output", type=Path, required=True) - parser.add_argument("--pose-name", default="rear_gga_raw_rear_to_front") + parser.add_argument("--pose-name", default="rtk_gga_raw_heading") parser.add_argument("--heading-offset-deg", type=float, required=True) parser.add_argument("--antenna-lever", type=float, nargs=3, required=True, metavar=("X", "Y", "Z")) parser.add_argument("--accepted-fixes", type=int, nargs="+", default=[4, 5]) @@ -140,12 +140,12 @@ def main() -> int: origin["lat"], origin["lon"]) corrected_heading = (item["heading"] + args.heading_offset_deg) % 360.0 yaw = math.radians(90.0 - corrected_heading) - body = antenna - yaw_rotation(yaw) @ lever - pose_rows.append(dict(zip(POSE_FIELDS, [item["time"], *body, 0.0, 0.0, + reference_position = antenna - yaw_rotation(yaw) @ lever + pose_rows.append(dict(zip(POSE_FIELDS, [item["time"], *reference_position, 0.0, 0.0, math.sin(yaw / 2.0), math.cos(yaw / 2.0)]))) summaries[index - 1].update({"sequence": index, "prepared_frame": destination.name, "corrected_heading_deg": corrected_heading}) - pose_path = args.output / f"body_poses_{args.pose_name}.csv" + pose_path = args.output / f"reference_poses_{args.pose_name}.csv" with pose_path.open("w", encoding="utf-8", newline="") as stream: writer = csv.DictWriter(stream, fieldnames=POSE_FIELDS); writer.writeheader(); writer.writerows(pose_rows) with (args.output / "station_summary.csv").open("w", encoding="utf-8", newline="") as stream: @@ -154,7 +154,7 @@ def main() -> int: document = {"source_combined_root": str(args.combined_root.resolve()), "station_count": len(selected), "rejected": rejected, "pose_csv": pose_path.name, "selection_policy": "middle LiDAR frame among fixed-position and valid-heading associations", - "body_pose_configuration": {"raw_heading_offset_deg": args.heading_offset_deg, + "reference_pose_configuration": {"raw_heading_offset_deg": args.heading_offset_deg, "antenna_lever_body_m": args.antenna_lever, "orientation_model": "yaw-only, identical to the previous calibration workflow"}, "stations": [{"sequence": i + 1, "source_station": item["station"], diff --git a/tools/prepare_station_dataset.py b/tools/prepare_station_dataset.py deleted file mode 100644 index 3cdf419..0000000 --- a/tools/prepare_station_dataset.py +++ /dev/null @@ -1,194 +0,0 @@ -#!/usr/bin/env python3 -"""Prepare one static LiDAR frame and one yaw-only RTK body pose per station.""" - -from __future__ import annotations - -import argparse -import csv -import json -import math -import re -import shutil -import sys -from pathlib import Path -from typing import Any - -import numpy as np - -POSE_FIELDS = ["time", "x", "y", "z", "qx", "qy", "qz", "qw"] - - -def parse_args() -> argparse.Namespace: - parser = argparse.ArgumentParser( - description="Select one static LiDAR frame per exported station and rebuild yaw-only RTK body poses." - ) - parser.add_argument("--export-root", type=Path, required=True, help="Directory containing exported station directories.") - parser.add_argument("--output", type=Path, required=True, help="Output prepared directory.") - parser.add_argument("--pose-name", default="rear_gga_raw_rear_to_front", help="Suffix of body_poses_.csv.") - parser.add_argument("--heading-offset-deg", type=float, required=True, help="Added to raw_heading_deg before ENU yaw conversion.") - parser.add_argument("--antenna-lever", type=float, nargs=3, metavar=("X", "Y", "Z"), required=True, help="Antenna position in body coordinates [m].") - parser.add_argument("--expected-stations", type=int, default=0, help="Require exactly this many usable stations; 0 disables.") - parser.add_argument("--min-stations", type=int, default=30, help="Fail below this many usable stations.") - parser.add_argument("--groups", nargs="*", default=None, help="Optional explicit station directory names.") - parser.add_argument("--accepted-fixes", type=int, nargs="+", default=[4, 5], help="Accepted GGA fix values.") - parser.add_argument("--heading-std-limit-deg", type=float, default=float("inf"), help="Reject a station above this heading circular stddev.") - parser.add_argument("--overwrite", action="store_true", help="Allow replacing generated files in a non-empty output directory.") - return parser.parse_args() - - -def truth(value: Any) -> bool: - return str(value).strip().lower() in {"1", "true", "yes", "y"} - - -def natural_key(value: str) -> list[Any]: - return [int(part) if part.isdigit() else part.lower() for part in re.split(r"(\d+)", value)] - -def read_csv(path: Path) -> list[dict[str, str]]: - with path.open("r", encoding="utf-8-sig", newline="") as stream: - return list(csv.DictReader(stream)) - - -def require_columns(rows: list[dict[str, str]], path: Path, columns: list[str]) -> None: - if not rows: - raise ValueError(f"{path}: no rows") - missing = [column for column in columns if column not in rows[0]] - if missing: - raise ValueError(f"{path}: missing required columns: {', '.join(missing)}") - - -def circular_mean_deg(values: np.ndarray) -> float: - radians = np.deg2rad(values) - return float(np.rad2deg(math.atan2(float(np.mean(np.sin(radians))), float(np.mean(np.cos(radians))))) % 360.0) - - -def circular_std_deg(values: np.ndarray) -> float: - radians = np.deg2rad(values) - resultant = max(math.hypot(float(np.mean(np.cos(radians))), float(np.mean(np.sin(radians)))), 1e-12) - return float(np.rad2deg(math.sqrt(-2.0 * math.log(resultant)))) - - -def geodetic_to_ecef(lat_deg: float, lon_deg: float, height_m: float) -> np.ndarray: - a, e2 = 6378137.0, 6.69437999014e-3 - lat, lon = math.radians(lat_deg), math.radians(lon_deg) - sin_lat, cos_lat, sin_lon, cos_lon = math.sin(lat), math.cos(lat), math.sin(lon), math.cos(lon) - n = a / math.sqrt(1.0 - e2 * sin_lat * sin_lat) - return np.array([(n + height_m) * cos_lat * cos_lon, (n + height_m) * cos_lat * sin_lon, (n * (1.0 - e2) + height_m) * sin_lat], dtype=float) - - -def ecef_to_enu(ecef: np.ndarray, origin_ecef: np.ndarray, origin_lat_deg: float, origin_lon_deg: float) -> np.ndarray: - lat, lon = math.radians(origin_lat_deg), math.radians(origin_lon_deg) - sin_lat, cos_lat, sin_lon, cos_lon = math.sin(lat), math.cos(lat), math.sin(lon), math.cos(lon) - rotation = np.array([[-sin_lon, cos_lon, 0.0], [-sin_lat * cos_lon, -sin_lat * sin_lon, cos_lat], [cos_lat * cos_lon, cos_lat * sin_lon, sin_lat]], dtype=float) - return rotation @ (ecef - origin_ecef) - - -def yaw_rotation(yaw: float) -> np.ndarray: - c, s = math.cos(yaw), math.sin(yaw) - return np.array([[c, -s, 0.0], [s, c, 0.0], [0.0, 0.0, 1.0]], dtype=float) - - -def select_frame(station: Path) -> tuple[dict[str, str], int, int]: - path = station / "reports" / "manifest.csv" - rows = read_csv(path) - require_columns(rows, path, ["status", "unix_time_ns", "output_file"]) - exported = [row for row in rows if row["status"] in {"exported", "resumed"}] - if not exported: - raise ValueError(f"{station.name}: no exported/resumed LiDAR frames") - valid = [row for row in exported if truth(row.get("rtk_position_valid")) and truth(row.get("rtk_heading_valid"))] - candidates = valid or exported - candidates.sort(key=lambda row: int(row["unix_time_ns"])) - return candidates[len(candidates) // 2], len(exported), len(valid) - - -def validation_checks(station: Path) -> dict[str, bool]: - path = station / "reports" / "validation_report.json" - if not path.exists(): - return {} - document = json.loads(path.read_text(encoding="utf-8")) - return {str(item.get("name")): bool(item.get("ok")) for item in document.get("checks", [])} - - -def process_station(station: Path, args: argparse.Namespace) -> tuple[dict[str, Any], dict[str, Any]]: - rtk_path = station / "rtk" / "gps_post_z.csv" - rows = read_csv(rtk_path) - columns = ["lat", "lon", "alt_m", "raw_heading_deg", "fix", "position_valid", "heading_valid", "unix_time_ns"] - require_columns(rows, rtk_path, columns) - fixes = set(args.accepted_fixes) - good = [row for row in rows if truth(row["position_valid"]) and truth(row["heading_valid"]) and int(row["fix"]) in fixes] - if not good: - raise ValueError(f"{station.name}: no RTK samples pass position/heading/fix filters") - lat = np.asarray([float(row["lat"]) for row in good]) - lon = np.asarray([float(row["lon"]) for row in good]) - alt = np.asarray([float(row["alt_m"]) for row in good]) - heading = np.asarray([float(row["raw_heading_deg"]) for row in good]) - times = np.asarray([int(row["unix_time_ns"]) for row in good], dtype=np.int64) - heading_std = circular_std_deg(heading) - if heading_std > args.heading_std_limit_deg: - raise ValueError(f"{station.name}: heading circular stddev {heading_std:.3f} deg exceeds {args.heading_std_limit_deg:.3f} deg") - frame, frame_count, valid_frame_count = select_frame(station) - source = station / frame["output_file"] - if not source.is_file(): - raise FileNotFoundError(f"{station.name}: selected frame is absent: {source}") - checks = validation_checks(station) - selected = {"station": station.name, "source_frame": source, "frame_time": int(frame["unix_time_ns"]) / 1e9, "lat_deg": float(np.mean(lat)), "lon_deg": float(np.mean(lon)), "alt_m": float(np.mean(alt)), "raw_heading_deg": circular_mean_deg(heading), "raw_heading_std_deg": heading_std} - summary = {"station": station.name, "selected_frame": frame["output_file"], "exported_frames": frame_count, "frames_with_valid_rtk": valid_frame_count, "valid_rtk_samples": len(good), "raw_heading_mean_deg": selected["raw_heading_deg"], "raw_heading_std_deg": heading_std, "alt_std_m": float(np.std(alt)), "rtk_span_sec": float((times.max() - times.min()) / 1e9) if len(times) > 1 else 0.0, "payload_ok": checks.get("lidar_payload_length", ""), "rtk_parse_ok": checks.get("gps_post_z_parse", ""), "time_check_3s_ok": checks.get("rtk_time_alignment", "")} - return selected, summary - - -def main() -> int: - args = parse_args() - if args.min_stations < 2 or args.expected_stations < 0: - raise ValueError("--min-stations must be >=2 and --expected-stations must be >=0") - if not args.export_root.is_dir(): - raise NotADirectoryError(args.export_root) - names = args.groups or [path.name for path in args.export_root.iterdir() if path.is_dir()] - stations = [args.export_root / name for name in sorted(names, key=natural_key)] - missing = [str(path) for path in stations if not path.is_dir()] - if missing: - raise FileNotFoundError("station directories do not exist: " + ", ".join(missing)) - selected, summaries, rejected = [], [], [] - for station in stations: - try: - item, summary = process_station(station, args) - selected.append(item); summaries.append(summary) - except (ValueError, FileNotFoundError) as error: - rejected.append({"station": station.name, "reason": str(error)}) - if args.expected_stations and len(selected) != args.expected_stations: - raise RuntimeError(f"expected {args.expected_stations} usable stations, got {len(selected)}; rejected={rejected}") - if len(selected) < args.min_stations: - raise RuntimeError(f"need at least {args.min_stations} usable stations, got {len(selected)}; rejected={rejected}") - output, frames_dir = args.output, args.output / "frames_all" - if output.exists() and any(output.iterdir()) and not args.overwrite: - raise FileExistsError(f"{output} is non-empty; pass --overwrite to replace generated files") - frames_dir.mkdir(parents=True, exist_ok=True) - origin = selected[0] - origin_ecef = geodetic_to_ecef(origin["lat_deg"], origin["lon_deg"], origin["alt_m"]) - lever = np.asarray(args.antenna_lever, dtype=float) - pose_rows = [] - for index, item in enumerate(selected, 1): - destination = frames_dir / f"station_{index:02d}.npz" - shutil.copy2(item["source_frame"], destination) - antenna_enu = ecef_to_enu(geodetic_to_ecef(item["lat_deg"], item["lon_deg"], item["alt_m"]), origin_ecef, origin["lat_deg"], origin["lon_deg"]) - corrected_heading = (item["raw_heading_deg"] + args.heading_offset_deg) % 360.0 - yaw = math.radians(90.0 - corrected_heading) - body_position = antenna_enu - yaw_rotation(yaw) @ lever - pose_rows.append(dict(zip(POSE_FIELDS, [item["frame_time"], *body_position, 0.0, 0.0, math.sin(yaw / 2.0), math.cos(yaw / 2.0)]))) - summaries[index - 1].update({"sequence": index, "prepared_frame": destination.name, "corrected_heading_deg": corrected_heading}) - pose_path = output / f"body_poses_{args.pose_name}.csv" - with pose_path.open("w", encoding="utf-8", newline="") as stream: - writer = csv.DictWriter(stream, fieldnames=POSE_FIELDS); writer.writeheader(); writer.writerows(pose_rows) - fields = sorted({key for row in summaries for key in row}) - with (output / "station_summary.csv").open("w", encoding="utf-8", newline="") as stream: - writer = csv.DictWriter(stream, fieldnames=fields); writer.writeheader(); writer.writerows(summaries) - manifest = {"source_export_root": str(args.export_root.resolve()), "station_count": len(selected), "pose_csv": pose_path.name, "frame_directory": "frames_all", "selection_policy": "middle frame among exported frames with valid RTK; falls back to middle exported frame", "rtk_filter": {"position_valid": True, "heading_valid": True, "accepted_fixes": args.accepted_fixes, "heading_std_limit_deg": args.heading_std_limit_deg}, "body_pose_configuration": {"raw_heading_offset_deg": args.heading_offset_deg, "antenna_lever_body_m": args.antenna_lever, "body_axes": "x forward, y left, z up; origin must match the supplied lever", "orientation_model": "yaw-only from raw_heading_deg; this tool does not reconstruct RTK pitch or roll"}, "enu_origin": {"lat_deg": origin["lat_deg"], "lon_deg": origin["lon_deg"], "alt_m": origin["alt_m"]}, "stations": [{"sequence": index + 1, "source_station": item["station"], "source_frame": str(item["source_frame"]), "prepared_frame": f"station_{index + 1:02d}.npz"} for index, item in enumerate(selected)]} - (output / "manifest.json").write_text(json.dumps(manifest, ensure_ascii=False, indent=2), encoding="utf-8") - print(json.dumps({"prepared": str(output.resolve()), "stations": len(selected), "rejected": rejected, "pose_csv": pose_path.name}, ensure_ascii=False, indent=2)) - return 0 - - -if __name__ == "__main__": - try: - raise SystemExit(main()) - except Exception as error: - print(f"ERROR: {error}", file=sys.stderr) - raise