Optimized Path Planning for Uninhabited Vehicles