Update 2-d tree and add test case
re-arrange 2-d tree
k-d tree implementation