oNm3Lk1ng:

怒赞博主，同时纠正

6.1

// if ss is a ompl::geometric::SimpleSetup object

ss.getSolutionPath().printAsMatrix(std::cout);

6.2

// if ss is a ompl::control::SimpleSetup object ss.getSolutionPath().asGeometric().printAsMatrix(std::cout);