Adding a kd tree for spatial hashing
Adding a kd tree for spatial hashing