/branches/MicroMag3_Nick666/trunc/compass.c |
---|
236,8 → 236,8 |
heading = atan2_i(x_corr, y_corr); |
// Skalieren von +-180° auf 0-360° |
heading += 360; |
heading %= 360; |
if (heading < 0) heading = -heading; |
else heading = 360 - heading; |
return (heading); |
} |
/branches/MicroMag3_Nick666/trunc/fc.c |
---|
912,7 → 912,7 |
KompassStartwert = KompassValue; |
NeueKompassRichtungMerken = 0; |
} |
Mess_Integral_Gier -= (KompassRichtung *Parameter_KompassWirkung); // nach Kompass ausrichten |
Mess_Integral_Gier += (KompassRichtung *Parameter_KompassWirkung); // nach Kompass ausrichten |
} |
} |
} |