| 7 | #include <iostream> |
| 8 | |
| 9 | void printStats( const MR::MultiwayICP& icp ) |
| 10 | { |
| 11 | std::cout << "Samples: " << icp.getNumSamples() << std::endl |
| 12 | << "Active point pairs: " << icp.getNumActivePairs() << std::endl; |
| 13 | if ( icp.getNumActivePairs() > 0 ) |
| 14 | { |
| 15 | const auto p2ptMetric = icp.getMeanSqDistToPoint(); |
| 16 | const auto p2plMetric = icp.getMeanSqDistToPlane(); |
| 17 | std::cout << "RMS point-to-point distance: " << p2ptMetric << " ± " << icp.getMeanSqDistToPoint( p2ptMetric ) << std::endl |
| 18 | << "RMS point-to-plane distance: " << p2plMetric << " ± " << icp.getMeanSqDistToPlane( p2plMetric ) << std::endl; |
| 19 | } |
| 20 | } |
| 21 | |
| 22 | int main( int argc, char* argv[] ) |
| 23 | { |
no test coverage detected