-Change costmap update radius back to 5.0