/branches/v0.60_MicroMag3_Nick666/trunc/compass.c |
---|
245,5 → 245,15 |
// Winkelberechnung |
heading = atan2_i(x_corr, y_corr); |
/* |
if (!x_corr && y_corr <0) return (90); |
if (!x_corr && y_corr >0) return (270); |
heading = atan(y_corr/x_corr)*57.29578; |
if (x_corr < 0) heading = 180-heading; |
if (x_corr > 0 && y_corr < 0) heading = -heading; |
if (x_corr > 0 && y_corr > 0) heading = 360 - heading; |
*/ |
return (heading); |
} |