hofee/nbv_sim
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fix transform

Browse Source
This commit is contained in:
Michel Breyer 2021-11-10 14:52:48 +01:00
parent 0ac5ca20aa
commit 406c53b309
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/active_grasp/simulation.py
View File

@ -175,7 +175,7 @@ class YamlScene(Scene):
scale = object.get("scale", 1)
if randomize := object.get("randomize", False):
angle = rng.uniform(-randomize["rot"], randomize["rot"])
ori *= Rotation.from_euler("z", angle, degrees=True)
ori = Rotation.from_euler("z", angle, degrees=True) * ori
b = np.asarray(randomize["pos"])
pos += rng.uniform(-b, b)
self.add_object(urdf, ori, pos, scale)