Спасибо Котяра и C4Grey. Попробовал один, он как то глючно работал, вторй вобще не работал. (хз конечно может я и натупил там, но без демо как то сложно соорентироваться). Короче написал свой алгоритм, вобщем меня полностью он устраивает, хотел еще все здвинуть, но как то лень стало и так пойдет))
http://vorodis2.com/#id:atlos
Если кому надо исходник там.