Fix bug that some point is at (0,0,0)