Fix some bugaroos ...  working on KD Tree bugs