Смысл попытки написать самостоятельно по алгоритму? Ну, во-первых, может пойму больше, а во-втоорых, в исодниках, которые я нашел в нете, все сильно тяжело написано, а хотелось бы проще.