[areostar]

Спасибо всем!! Проблемма решена!! Проблема былаво первых один из параметров передовался не так(ошибка в другом файле) и во вторых с тригонометрией проблема была(радианы в градусы перегнал!!)