Subversion Repositories FlightCtrl

Rev

Rev 194 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 194 Rev 224
Line 103... Line 103...
103 
 
 103 
 
104 
 winkel = pgm_read_word(&pgm_sinus[winkel]);
 104 
 winkel = pgm_read_word(&pgm_sinus[winkel]);
105 
 return (winkel*m*n);
 105 
 return (winkel*m*n);
Line -... Line 106...
- 
 
 106 
}
- 
 
 107 
 
- 
 
 108 
// Aus x,y und Winkel Distanz ermitteln
- 
 
 109 
long get_dist(signed int x, signed int y, signed int phi)
- 
 
 110 
{
- 
 
 111 
        long dist;
- 
 
 112 
        if (abs(x) > abs(y) )
- 
 
 113 
        {
- 
 
 114 
                dist = (long) x; //Groesseren Wert wegen besserer Genauigkeit nehmen
- 
 
 115 
                dist = abs((dist *1000) / (long) sin_i(phi));
- 
 
 116 
        }
- 
 
 117 
        else
- 
 
 118 
        {
- 
 
 119 
                dist = (long) y;
- 
 
 120 
                dist = abs((dist *1000) / (long) cos_i(phi));
- 
 
 121 
        }
- 
 
 122 
  return dist;