Utility Function Derived Off-Road Vehicle Path Planning