Practice and comp robot calibration for MTTD
Need to make the catapult range change per robot
Change-Id: I830855614d07f5fea484b9eb2a932c7f25bd6901
Signed-off-by: Austin Schuh <austin.linux@gmail.com>
diff --git a/y2022/vision/camera_definition.py b/y2022/vision/camera_definition.py
index d3e44b7..3b34ca2 100644
--- a/y2022/vision/camera_definition.py
+++ b/y2022/vision/camera_definition.py
@@ -109,24 +109,24 @@
camera_yaw = 0.0
T = np.array([-9.5 * 0.0254, -3.5 * 0.0254, 34.5 * 0.0254])
elif pi_number == "pi3":
- camera_yaw = 179.0 * np.pi / 180.0
+ camera_yaw = 182.0 * np.pi / 180.0
T = np.array([-9.5 * 0.0254, 3.5 * 0.0254, 34.5 * 0.0254])
elif pi_number == "pi4":
camera_yaw = -90.0 * np.pi / 180.0
T = np.array([-10.25 * 0.0254, -5.0 * 0.0254, 27.5 * 0.0254])
elif team_number == 9971:
if pi_number == "pi1":
- camera_yaw = 180.5 * np.pi / 180.0
+ camera_yaw = 179.0 * np.pi / 180.0
T = np.array([-9.5 * 0.0254, 3.25 * 0.0254, 35.5 * 0.0254])
elif pi_number == "pi2":
camera_yaw = 0.0
T = np.array([-9.0 * 0.0254, -3.25 * 0.0254, 35.5 * 0.0254])
elif pi_number == "pi3":
camera_yaw = 90.0 * np.pi / 180.0
- T = np.array([-10.5 * 0.0254, -5.0 * 0.0254, 29.5 * 0.0254])
+ T = np.array([-10.5 * 0.0254, 5.0 * 0.0254, 29.5 * 0.0254])
elif pi_number == "pi4":
camera_yaw = -90.0 * np.pi / 180.0
- T = np.array([-10.5 * 0.0254, 5.0 * 0.0254, 28.0 * 0.0254])
+ T = np.array([-10.5 * 0.0254, -5.0 * 0.0254, 28.5 * 0.0254])
else:
glog.fatal("Unknown team number for extrinsics")