| /branches/v0.60_MicroMag3_Nick666/trunc/compass.c |
|---|
| 244,6 → 244,16 |
| // 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); |
| } |