Take care of the TODO in the autonomous class for looking at Jevois output.
The jevois will increment a counter after it acquires a new target (in response to the "latch" command). Update the roboRIO code to wait first for this counter to update before looking at any points. Then read back a few samples (at least 3 or 4) and make sure they're all pretty much in the same spot. if there's big differences keep waiting till you get good samples.
Have a timeout on the whole thing - if it takes more than a second to do get good data, abandon attempting to do auto mode.
Flash a red light on the dashboard if auto mode is being requested, but cannot be executed.
Take care of the TODO in the autonomous class for looking at Jevois output.
The jevois will increment a counter after it acquires a new target (in response to the "latch" command). Update the roboRIO code to wait first for this counter to update before looking at any points. Then read back a few samples (at least 3 or 4) and make sure they're all pretty much in the same spot. if there's big differences keep waiting till you get good samples.
Have a timeout on the whole thing - if it takes more than a second to do get good data, abandon attempting to do auto mode.
Flash a red light on the dashboard if auto mode is being requested, but cannot be executed.