Subversion Repositories FlightCtrl

Rev

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

Rev 258 Rev 266
Line 106... Line 106...
106 
 winkel = pgm_read_word(&pgm_sinus[winkel]);
 106 
 winkel = pgm_read_word(&pgm_sinus[winkel]);
107 
 return (winkel*m*n);
 107 
 return (winkel*m*n);
108 
}
 108 
}
Line 109... Line 109...
109 
 
 109 
 
110 
// Aus x,y und Winkel Distanz ermitteln
 110 
// Aus x,y und Winkel Distanz ermitteln
111 
int get_dist(signed int x, signed int y, signed int phi)
 111 
long get_dist(signed int x, signed int y, signed int phi)
112 
{
 112 
{
113 
        long dist;
 113 
        long dist;
114 
        if (abs(x) > abs(y) )
 114 
        if (abs(x) > abs(y) )
115 
        {
 115 
        {
Line 119... Line 119...
119 
        else
 119 
        else
120 
        {
 120 
        {
121 
                dist = (long) y;
 121 
                dist = (long) y;
122 
                dist = abs((dist *1000) / (long) cos_i(phi));
 122 
                dist = abs((dist *1000) / (long) cos_i(phi));
123 
        }
 123 
        }
124 
  return (int)dist;
 124 
  return dist;
125 
}
 125 
}