Teleop working nicely hopefully