| /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 |