diff --git a/src/iiwa_bringup/launch/digital_twin.launch.py b/src/iiwa_bringup/launch/digital_twin.launch.py index 549b387..49692c4 100644 --- a/src/iiwa_bringup/launch/digital_twin.launch.py +++ b/src/iiwa_bringup/launch/digital_twin.launch.py @@ -17,6 +17,7 @@ from moveit_configs_utils import MoveItConfigsBuilder from iiwa_bringup.utils import converter + PACKAGE = "iiwa_bringup" DESCRIPTION_PKG = "iiwa_description" @@ -95,6 +96,10 @@ def _runtime_setup(context, *args, **kwatgs): .joint_limits(file_path=joint_limits_yaml) .pilz_cartesian_limits(file_path=pilz_limits_yaml) .trajectory_execution(file_path=moveit_controllers_yaml) + .planning_pipelines( + pipelines=["ompl", "stomp", "pilz_industrial_motion_planner"], + default_planning_pipeline="pilz_industrial_motion_planner", + ) .to_moveit_configs() ) diff --git a/src/iiwa_object_spawner/iiwa_object_spawner/object_spawner.py b/src/iiwa_object_spawner/iiwa_object_spawner/object_spawner.py index 7be7805..f7b0e42 100644 --- a/src/iiwa_object_spawner/iiwa_object_spawner/object_spawner.py +++ b/src/iiwa_object_spawner/iiwa_object_spawner/object_spawner.py @@ -74,9 +74,9 @@ class ObjectSpawner(Node): def main(args=None): try: - with rclpy.init(args=args): - node = ObjectSpawner() - rclpy.spin(node=node) + rclpy.init(args=args) + node = ObjectSpawner() + rclpy.spin(node=node) except (KeyboardInterrupt, ExternalShutdownException): pass