https://123dok.org/document/yr35npoy-chapter-initialization-and-outlier-rejection-algorithms.html