Dimasv, во первых оформи код тегом [code], а во вторых напиши комментарии.
Да, и про табуляцию текста не забудь. Привыкай уважать в первую очередь себя, и предоставлять на проверку читаемый код.
В дополнение к ним (комментариям), можешь дать ссылку на реализуемую расчетную формулу.
С виду, уже на что-то похоже. Давай, внеси поправки, и уже можно будет детально порыться
