Skip to content

Commit

Permalink
remove commented out test code
Browse files Browse the repository at this point in the history
  • Loading branch information
Lexseal committed Apr 20, 2024
1 parent 4ac8223 commit 52adf0d
Showing 1 changed file with 0 additions and 22 deletions.
22 changes: 0 additions & 22 deletions mplib/examples/collision_avoidance.py
Original file line number Diff line number Diff line change
Expand Up @@ -58,28 +58,6 @@ def __init__(self):

planning_world = SapienPlanningWorld(self.scene, [self.robot])
self.planner = SapienPlanner(planning_world, "panda_hand")
# self.planner.IK(
# goal_pose=Pose([0.7, 0, 0.32], [0, 1, 0, 0]),
# start_qpos=np.array([0, 0.19, 0.0, -2.61, 0.0, 2.94, 0.78, 0, 0]),
# verbose=True,
# )
# # self.setup_planner(
# # urdf_path="./data/panda/panda.urdf", srdf_path="./data/panda/panda.srdf"
# # )
# # self.planner.robot.set_qpos(init_qpos, full=True)
# # for obj in self.planner.robot.get_fcl_model().get_collision_objects():
# # print(obj.name, obj.pose)
# # for i, link in enumerate(
# # self.planner.robot.get_pinocchio_model().get_link_names()
# # ):
# # print(link, self.planner.robot.get_pinocchio_model().get_link_pose(i))
# # for obj in self.planner2.robot.get_fcl_model().get_collision_objects():
# # print(obj.name, obj.pose)
# # for i, link in enumerate(
# # self.planner2.robot.get_pinocchio_model().get_link_names()
# # ):
# # print(link, self.planner2.robot.get_pinocchio_model().get_link_pose(i))
# exit(0)

def demo(self, with_screw=True, use_attach=True):
"""
Expand Down

0 comments on commit 52adf0d

Please sign in to comment.