robot Periodic
This method is called every 20 ms, no matter the mode. Use this for items like diagnostics that you want ran during disabled, autonomous, teleoperated and test.
This runs after the mode specific periodic methods, but before LiveWindow and SmartDashboard integrated updating.