GreM, попробуй эту поправку.
sаmakacd, глянь, правильно ли я понял логику кода.