change nan to inf filter to handle max_range+ values as well. need to sort this all out in navigation