Add first steps of algorithm