Вам нужен именно алгоритм, или у Вас проблемы с синтаксисом?