Skip to content

Commit

Permalink
Merge branch 'main' into feat/restructure-trajectory-classes
Browse files Browse the repository at this point in the history
  • Loading branch information
bpapaspyros committed Jan 28, 2025
2 parents fe5c9a2 + f72569e commit c4e59c8
Show file tree
Hide file tree
Showing 2 changed files with 6 additions and 5 deletions.
1 change: 1 addition & 0 deletions CHANGELOG.md
Original file line number Diff line number Diff line change
Expand Up @@ -20,6 +20,7 @@ Release Versions
## Upcoming changes

- feat: improve support for transformation matrices (#146)
- fix: unstable python test (#221)
- feat: split trajectory classes and implement Cartesian/JointState specializations (#216)

## 9.1.0
Expand Down
10 changes: 5 additions & 5 deletions python/test/state_representation/space/joint/test_joint_state.py
Original file line number Diff line number Diff line change
Expand Up @@ -481,19 +481,19 @@ def test_utilities(self):
with self.assertRaises(IncompatibleSizeError):
state.set_state_variable([1.0, 2.0, 3.0, 4.0], JointStateVariable.POSITIONS)
state.set_state_variable([1.0, 2.0, 3.0], JointStateVariable.POSITIONS)
self.assertTrue((state.get_state_variable(JointStateVariable.POSITIONS) == [1.0, 2.0, 3.0]).all())
self.assertTrue((state.get_state_variable(state_variable_type) == [1.0, 2.0, 3.0]).all())
self.assert_np_array_equal(state.get_state_variable(JointStateVariable.POSITIONS), [1.0, 2.0, 3.0])
self.assert_np_array_equal(state.get_state_variable(state_variable_type), [1.0, 2.0, 3.0])

matrix = np.random.rand(3, 3)
expected = matrix @ np.array([1.0, 2.0, 3.0])
state.multiply_state_variable(matrix, JointStateVariable.POSITIONS)
self.assertTrue((state.get_positions() == expected).all())
self.assert_np_array_equal(state.get_positions(), expected)

state.set_state_variable([4.0, 5.0, 6.0], JointStateVariable.POSITIONS)
self.assertTrue((state.get_state_variable(JointStateVariable.POSITIONS) == [4.0, 5.0, 6.0]).all())
self.assert_np_array_equal(state.get_state_variable(JointStateVariable.POSITIONS), [4.0, 5.0, 6.0])

state.set_state_variable(np.array([7.0, 8.0, 9.0]), JointStateVariable.POSITIONS)
self.assertTrue((state.get_positions() == [7.0, 8.0, 9.0]).all())
self.assert_np_array_equal(state.get_positions(), [7.0, 8.0, 9.0])

if __name__ == '__main__':
unittest.main()

0 comments on commit c4e59c8

Please sign in to comment.