Added more functions on box intersection and plane splitting
Started implementing a better kd-tree construction algorithm