/branches/salvo_gps/math_alt.c |
---|
23,12 → 23,18 |
{ |
float rad,r; |
signed int angle; |
short int m; |
if (!x && !y) return 0; |
if ( !x && !y) return 0; |
if (y < 0) |
{ |
y = abs(y); |
m = -1; // neg. für Quadrant III + IV |
} |
else m = 1; |
y = abs(y); |
if (x>=0) |
{ |
r = (x - y) / (x + y); |
41,9 → 47,8 |
} |
angle = (360 * rad) / 6.2832; |
if (y < 0) return(-angle); // negate if in quad III or IV |
else return(angle); |
return(angle*m); |
} |
// cosinus Funktion: Eingabewert Winkel in Grad, Rueckgabe =cos(winkel)*1000 |