∀j ∈ [1, m], E(1, j) = 0

for i = 2 to n {n number of contour points}

for j = 1 to m {m number of states of each contour point}

$$\begin{array}{lll}E(i,j)& =& \underset{l,l\in [1,m]}{min}\{E(i-1,l)\\ & & +{\alpha }_{p_l}{\mid p_l-p_{i-1,j}\mid }^2+{\beta }_{p_l}{\mid p_{i+1,j}-2p_l+p_{i-1,j}\mid }^2\\ & & +(I_{p_l},I_{p_l})·(n_{p_i},n_{p_i})+d_{p_l}\}\end{array}$$

P(i, j) = l for min E(i, j); {stores minimum energy state}

end

end