KD-Tree Simplified & FastAsFuck Added