Using Multiple Fidelity Models in Motion Planning