Skip to content

Commit

Permalink
Merge branch 'UM-ARM-Lab:master' into add-ik-test-cases
Browse files Browse the repository at this point in the history
  • Loading branch information
StoneT2000 authored Aug 29, 2024
2 parents 6a4e8e9 + f661187 commit bdb1853
Showing 1 changed file with 3 additions and 2 deletions.
5 changes: 3 additions & 2 deletions tests/test_kinematics.py
Original file line number Diff line number Diff line change
Expand Up @@ -281,12 +281,13 @@ def test_fk_partial_batched():


def test_ur5_fk():
pk_chain = pk.build_serial_chain_from_urdf(open('ur5.urdf').read(), 'ee_link', 'base_link')
urdf = os.path.join(TEST_DIR, "ur5.urdf")
pk_chain = pk.build_serial_chain_from_urdf(open(urdf).read(), 'ee_link', 'base_link')
th = [0.0, -math.pi / 4.0, 0.0, math.pi / 2.0, 0.0, math.pi / 4.0]

try:
import ikpy.chain
ik_chain = ikpy.chain.Chain.from_urdf_file('ur5.urdf',
ik_chain = ikpy.chain.Chain.from_urdf_file(urdf,
active_links_mask=[False, True, True, True, True, True, True, False])
ik_ret = ik_chain.forward_kinematics([0, *th, 0])
except ImportError:
Expand Down

0 comments on commit bdb1853

Please sign in to comment.