37
37
from ..planning .ompl import OMPLSimplifier
38
38
from ..planning .retimer import HauserParabolicSmoother , OpenRAVEAffineRetimer , ParabolicRetimer
39
39
from ..planning .mac_smoother import MacSmoother
40
- from ..util import CopyTrajectory , GetTrajectoryTags , SetTrajectoryTags , TagTrajectoryTiming
40
+ from ..util import SetTrajectoryTags
41
41
42
42
logger = logging .getLogger ('robot' )
43
43
@@ -378,7 +378,7 @@ def do_execute():
378
378
379
379
with Timer () as timer :
380
380
traj = self .PostProcessPath (path , defer = False , ** kwargs )
381
- TagTrajectoryTiming (traj , Tags .POSTPROCESS_TIME , timer .get_duration ())
381
+ SetTrajectoryTags (traj , { Tags .POSTPROCESS_TIME : timer .get_duration ()}, append = True )
382
382
383
383
logger .info ('Post-processing took %.3f seconds and produced a path'
384
384
' with %d waypoints and a duration of %.3f seconds.' ,
@@ -389,7 +389,7 @@ def do_execute():
389
389
390
390
with Timer () as timer :
391
391
exec_traj = self .ExecuteTrajectory (traj , defer = False , ** kwargs )
392
- TagTrajectoryTiming (exec_traj , Tags .EXECUTION_TIME , timer .get_duration ())
392
+ SetTrajectoryTags (exec_traj , { Tags .EXECUTION_TIME : timer .get_duration ()}, append = True )
393
393
return exec_traj
394
394
395
395
if defer is True :
@@ -549,7 +549,7 @@ def _PlanWrapper(self, planning_method, args, kw_args):
549
549
from ..util import Timer
550
550
with Timer () as timer :
551
551
result = planning_method (self , * args , ** kw_args )
552
- TagTrajectoryTiming (result , Tags .PLAN_TIME , timer .get_duration ())
552
+ SetTrajectoryTags (result , { Tags .PLAN_TIME : timer .get_duration ()}, append = True )
553
553
554
554
def postprocess_trajectory (traj ):
555
555
# Strip inactive DOFs from the trajectory.
0 commit comments