diff --git a/src/manipulation-planner.cc b/src/manipulation-planner.cc index 6d52b142517bf9830080bb2aa8b818e664bbe6fd..f901a7f790fa9622a9aebea0b2ffde8ccb885b24 100644 --- a/src/manipulation-planner.cc +++ b/src/manipulation-planner.cc @@ -119,6 +119,8 @@ namespace hpp { HPP_START_TIMECOUNTER(extend); bool pathIsValid = extend (near, q_rand, path); + HPP_STOP_TIMECOUNTER(extend); + HPP_DISPLAY_LAST_TIMECOUNTER(extend); // Insert new path to q_near in roadmap if (pathIsValid) { value_type t_final = path->timeRange ().second; @@ -135,8 +137,8 @@ namespace hpp { } } - HPP_STOP_TIMECOUNTER(extend); - HPP_DISPLAY_LAST_TIMECOUNTER(extend); + + } } @@ -172,6 +174,8 @@ namespace hpp { HPP_DISPLAY_TIMECOUNTER(oneStep); HPP_DISPLAY_TIMECOUNTER(extend); HPP_DISPLAY_TIMECOUNTER(tryConnect); + HPP_DISPLAY_TIMECOUNTER(tryConnectNewNodes); + HPP_DISPLAY_TIMECOUNTER(tryConnectToRoadmap); HPP_DISPLAY_TIMECOUNTER(nearestNeighbor); HPP_DISPLAY_TIMECOUNTER(delayedEdges); HPP_DISPLAY_TIMECOUNTER(chooseEdge);