kd trees: Hopefully finally correct implementation

! The splitting point should not be sorted into the child trees, but
  rather be the node itself