Skip to content

Commit 0e12e88

Browse files
committed
Removing logic to strip inactive dofs. This isn't needed for base trajectories. Changing Forward and Rotate to call ExecuteBasePath.
1 parent 1274a45 commit 0e12e88

File tree

1 file changed

+2
-8
lines changed

1 file changed

+2
-8
lines changed

src/prpy/base/mobilebase.py

Lines changed: 2 additions & 8 deletions
Original file line numberDiff line numberDiff line change
@@ -97,7 +97,7 @@ def Forward(self, meters, execute=True, direction=None, **kw_args):
9797

9898
traj = create_affine_trajectory(self.robot, [ start_pose, goal_pose ])
9999
if execute:
100-
return self.robot.ExecuteTrajectory(traj, **kw_args)
100+
return self.ExecuteBasePath(traj, **kw_args)
101101
else:
102102
return traj
103103
else:
@@ -118,7 +118,7 @@ def Rotate(self, angle_rad, execute=True, **kw_args):
118118

119119
traj = create_affine_trajectory(self.robot, [ start_pose, goal_pose ])
120120
if execute:
121-
return self.robot.ExecuteTrajectory(traj, **kw_args)
121+
return self.ExecuteBasePath(traj, **kw_args)
122122
else:
123123
return traj
124124
else:
@@ -158,12 +158,6 @@ def _BasePlanWrapper(self, planning_method, args, kw_args):
158158
)
159159
cloned_traj = planning_method(cloned_robot, *args, **kw_args)
160160

161-
# Strip inactive DOFs from the trajectory
162-
config_spec = cloned_robot.GetActiveConfigurationSpecification()
163-
openravepy.planningutils.ConvertTrajectorySpecification(
164-
cloned_traj, config_spec
165-
)
166-
167161
# Copy the trajectory back to the original environment.
168162
from ..util import CopyTrajectory
169163
traj = CopyTrajectory(cloned_traj, env=robot.GetEnv())

0 commit comments

Comments
 (0)