Subversion Repositories FlightCtrl

Rev

Rev 384 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 384 Rev 385
Line 29... Line 29...
29
        if (y < 0) m=-1;
29
        if (y < 0) m=-1;
30
        else m=1;
30
        else m=1;
Line 31... Line 31...
31
       
31
       
Line 32... Line 32...
32
        if (x==0) return (90*m);                // atan2 = 90° für x = 0
32
        if (x==0) return (90*m);                // atan2 = 90° für x = 0
Line 33... Line 33...
33
       
33
       
34
        i = abs(((long)y*100 / x) / 2);         // Berechne i für die Lookup table (Schrittweite atan(x) ist 0.02 -> *50)
34
        i = abs((long)y*50 / x);                // Berechne i für die Lookup table (Schrittweite atan(x) ist 0.02 -> *50)
35
 
35
 
36
        if (i<270) angle = pgm_read_byte(&pgm_atan[i]); // Lookup für 1° bis 79°
36
        if (i<270) angle = pgm_read_byte(&pgm_atan[i]); // Lookup für 1° bis 79°