Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 223 → Rev 224

/branches/salvo_gps/math.c
105,3 → 105,20
return (winkel*m*n);
}
 
// Aus x,y und Winkel Distanz ermitteln
long get_dist(signed int x, signed int y, signed int phi)
{
long dist;
if (abs(x) > abs(y) )
{
dist = (long) x; //Groesseren Wert wegen besserer Genauigkeit nehmen
dist = abs((dist *1000) / (long) sin_i(phi));
}
else
{
dist = (long) y;
dist = abs((dist *1000) / (long) cos_i(phi));
}
return dist;
}