Started adding the KD-tree for triangles