Add of the algorithm
Little modifications ~