The CommandRobot way will give you your desired outcome with the least amount of swimming upstream. I recommend giving that a look. (I'd also highly recommend at least looking at the source code you would be building on top of
https://github.com/eshsrobotics/wpil...Scheduler.java)