Updated Tetrahedron barycentric calculation to be more robust