(icp)
| 3 | |
| 4 | |
| 5 | def print_stats(icp): |
| 6 | num_active_pairs = icp.getNumActivePairs() |
| 7 | print(f"Samples: {icp.getNumSamples()}") |
| 8 | print(f"Active point pairs: {num_active_pairs}") |
| 9 | |
| 10 | if num_active_pairs > 0: |
| 11 | p2pt_metric = icp.getMeanSqDistToPoint() |
| 12 | p2pt_inaccuracy = icp.getMeanSqDistToPoint(p2pt_metric) |
| 13 | print(f"RMS point-to-point distance: {p2pt_metric} ± {p2pt_inaccuracy}") |
| 14 | |
| 15 | p2pl_metric = icp.getMeanSqDistToPlane() |
| 16 | p2pl_inaccuracy = icp.getMeanSqDistToPlane(p2pl_metric) |
| 17 | print(f"RMS point-to-plane distance: {p2pl_metric} ± {p2pl_inaccuracy}") |
| 18 | |
| 19 | |
| 20 | def main(argv): |
no test coverage detected