Add more geometry test. Refactor KDTree code
Merge remote-tracking branch 'origin/master'

* origin/master:
  Fix circle.h.
  Add common area of two circle function.