MSP: Track KDTree height and imbalance
MSP: Implement KDTree rebuilding
MSP: Inline two tree functions
MSP: Optimize new/delete usage in tree rebuilds
MSP: Pass path pointers by reference in KDTree
MSP: Run KDTree through astyle