Ничего посоветовать из готового не могу. Но скажу прямо, алгоритм несложний -- два года тому назад реализировав его за 6 часов к здачи в универе. И польза вам будет, и проекту -- ваши оптимизации, ваши идеи. (Сори за русский -- у меня нет русской раскладки клавиатури; а главное, нету знаний русского язика).