Added least-squares optimization of a plane
Implemented octree recursion for plane detection