例えば、
>const double rad = 0.0174532925;
↓
const double rad = PI/180;

くらいはしてほしい。。