>>781
正規化はこうしておけ
rad は double

if (rad > 2 * M_PI)
{
rad -= 2 * M_PI * (int)(rad / (2 * M_PI));
}