Skip to content

Commit edee1b0

Browse files
committed
Fix bug in cartesian planner: Merges trajectory point data into robot configuration
Replaces assignment of joint values with a merge operation to incorporate all data from the trajectory point, ensuring that the robot configuration is fully updated with the latest state.
1 parent ab444aa commit edee1b0

1 file changed

Lines changed: 2 additions & 1 deletion

File tree

src/compas_fab/backends/pybullet/backend_features/pybullet_plan_cartesian_motion.py

Lines changed: 2 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -804,7 +804,8 @@ def plan_cartesian_motion_frame_waypoints(
804804
tolerance_position=waypoints.tolerance_orientation,
805805
tolerance_orientation=waypoints.tolerance_orientation,
806806
)
807-
intermediate_state.robot_configuration.joint_values = trajectory.points[-1].joint_values
807+
# intermediate_state.robot_configuration.joint_values = trajectory.points[-1].joint_values
808+
intermediate_state.robot_configuration.merge(trajectory.points[-1])
808809
if options["verbose"]:
809810
print(
810811
"Segment {} of {}, j={}, t = {}, Interpolated Frame = {}".format(

0 commit comments

Comments
 (0)