[Gvozd]

SunYang,
по той ссылке же все есть, что надо!
описание алгоритма, исходные коды
вы что совсем обленились?
не можете скопипастить себе кусок кода, и слегка поправить под свои нужды?