Move teleopPeriodic control logic to RobotTeleop