Last minute updates and fixes afterwards. Teleop stuff too.