Skip to content

Commit 7731faf

Browse files
james-wardLucienMorey
authored andcommitted
Include missing rotation
1 parent b16d0a5 commit 7731faf

File tree

1 file changed

+5
-1
lines changed

1 file changed

+5
-1
lines changed

components/vision.py

Lines changed: 5 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -204,7 +204,11 @@ def robot_to_camera(self, timestamp: float) -> Transform3d:
204204
if turret_rotation is None:
205205
return self.robot_to_turret
206206
r2t = self.robot_to_turret.translation()
207-
t2c = self.turret_to_camera.translation().rotateBy(Rotation3d(turret_rotation))
207+
t2c = (
208+
self.turret_to_camera.translation()
209+
.rotateBy(self.turret_to_camera.rotation())
210+
.rotateBy(Rotation3d(turret_rotation))
211+
)
208212
trans = r2t + t2c
209213
rot = (
210214
self.robot_to_turret.rotation()

0 commit comments

Comments
 (0)