SYSTEM AND METHOD FOR OPTIMIZING AUTONOMOUS VEHICLE CAPABILITIES IN ROUTE PLANNING