Fixed the blue problem.

Used DEG2RAD on the costheta