Fill camera calibration data on teensy.
Change-Id: Ia8450bedba203ec14d824229bb1f2e9e788bd340
diff --git a/y2019/jevois/teensy.cc b/y2019/jevois/teensy.cc
index 53c5a61..afcc9c7 100644
--- a/y2019/jevois/teensy.cc
+++ b/y2019/jevois/teensy.cc
@@ -740,7 +740,9 @@
const y2019::vision::CameraCalibration *const constants =
y2019::vision::GetCamera(CameraSerialNumbers()[i]);
(void)constants;
- // TODO(Brian): Actually fill out the calibration field.
+ calibration.calibration(0, 0) = constants->intrinsics.mount_angle;
+ calibration.calibration(0, 1) = constants->intrinsics.focal_length;
+ calibration.calibration(0, 2) = constants->intrinsics.barrel_mount;
transmit_buffers[i].MaybeWritePacket(calibration);
}
}