Skip to main content
. 2012 Oct 12;12(10):13736–13752. doi: 10.3390/s121013736
Algorithm 2. Algorithm of ICP-based plane refinement.

RefinePlaneICP

Input: Point cloud G, initial plane n0, error tolerance ∈, number of iterations k
Output: Refined plane nk

1 n0BestFitPlane(Pi)
2 For i = 1 to k
3 Pi ← {pG : δ(p, ni−1) < ε}, niBestFitPlane(Pi)
4  If ‖nini−1‖ is small
5   nkni, ik // early stop
6  End If
7 End For