We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
There was an error while loading. Please reload this page.
1 parent b16d0a5 commit 7731fafCopy full SHA for 7731faf
components/vision.py
@@ -204,7 +204,11 @@ def robot_to_camera(self, timestamp: float) -> Transform3d:
204
if turret_rotation is None:
205
return self.robot_to_turret
206
r2t = self.robot_to_turret.translation()
207
- t2c = self.turret_to_camera.translation().rotateBy(Rotation3d(turret_rotation))
+ t2c = (
208
+ self.turret_to_camera.translation()
209
+ .rotateBy(self.turret_to_camera.rotation())
210
+ .rotateBy(Rotation3d(turret_rotation))
211
+ )
212
trans = r2t + t2c
213
rot = (
214
self.robot_to_turret.rotation()
0 commit comments