more checks on path correctness
more checks on path correctness

--HG--
extra : convert_revision : 4b8208fdc62e4295126ecabf73f521d65eef28f5

florianhauer/ompl,jvgomez/ompl,davetcoleman/ompl,davetcoleman/ompl,sonny-tarbouriech/ompl,utiasASRL/batch-informed-trees,utiasASRL/batch-informed-trees,sonny-tarbouriech/ompl,florianhauer/ompl,florianhauer/ompl,sonny-tarbouriech/ompl,utiasASRL/batch-informed-trees,jvgomez/ompl,jvgomez/ompl,jvgomez/ompl,utiasASRL/batch-informed-trees,davetcoleman/ompl,davetcoleman/ompl,florianhauer/ompl,florianhauer/ompl,davetcoleman/ompl,sonny-tarbouriech/ompl,sonny-tarbouriech/ompl,utiasASRL/batch-informed-trees,jvgomez/ompl,davetcoleman/ompl,sonny-tarbouriech/ompl,utiasASRL/batch-informed-trees,jvgomez/ompl,florianhauer/ompl