Small changes for testing at EPA
Do check for correct hostname parsing in intrinsics, since
this otherwise fails not so gracefully if it's not right
Send points that are rejected due to lack of undistort converging
in a different color (orange instead of red) to foxglove
Change-Id: I231ca62ff4ca7d1d7000b0b159c253401d5e77a9
Signed-off-by: Jim Ostrowski <yimmy13@gmail.com>
diff --git a/frc971/vision/intrinsics_calibration.cc b/frc971/vision/intrinsics_calibration.cc
index d3ddba7..e0ec38c 100644
--- a/frc971/vision/intrinsics_calibration.cc
+++ b/frc971/vision/intrinsics_calibration.cc
@@ -44,6 +44,13 @@
"camera moves.";
std::unique_ptr<aos::ExitHandle> exit_handle = event_loop.MakeExitHandle();
+ CHECK(aos::network::ParsePiOrOrin(hostname))
+ << "Failed to parse node type from " << hostname
+ << ". Should be of form orin1-971-1";
+ CHECK(aos::network::ParsePiOrOrinNumber(hostname))
+ << "Failed to parse node number from " << hostname
+ << ". Should be of form orin2-7971-1";
+
std::string camera_name = absl::StrCat(
"/", aos::network::ParsePiOrOrin(hostname).value(),
std::to_string(aos::network::ParsePiOrOrinNumber(hostname).value()),