KD Trees added for future planning