diff --git a/tests/curobo_robot_world_model_test.py b/tests/curobo_robot_world_model_test.py index 0778308..4991e7d 100644 --- a/tests/curobo_robot_world_model_test.py +++ b/tests/curobo_robot_world_model_test.py @@ -134,3 +134,9 @@ def test_cu_robot_batch_world_collision(): ) assert d_world.shape[0] == b assert torch.sum(d_world) == 0.0 + +def test_cu_robot_get_link_transform(): + model = load_robot_world() + world_T_panda_hand = model.kinematics.get_link_transform("panda_hand") + # It seems the panda hand is initialized at the origin. + assert torch.sum(world_T_panda_hand.position) == 0.0 \ No newline at end of file