Python set_to_end Examples

Example #1

File: test_arms_and_configuration_paths.py Project: corl20paper526/midlevel

 def test_get_linear_path_and_get_end(self):
     arm = Panda()
     waypoint = Dummy('Panda_waypoint')
     path = arm.get_linear_path(
         waypoint.get_position(), waypoint.get_orientation())
     path.set_to_end()
     self.assertTrue(np.allclose(
         arm.get_tip().get_position(), waypoint.get_position(), atol=0.001))

Example #2

 def test_get_linear_path_and_get_end(self):
     mobile = YouBot()
     waypoint = Dummy('youBot_waypoint')
     path = mobile.get_linear_path(waypoint.get_position(),
                                   waypoint.get_orientation()[-1])
     path.set_to_end()
     self.assertTrue(
         np.allclose(mobile.get_position()[:2],
                     waypoint.get_position()[:2],
                     atol=0.001))