fly/flightgear
1
0
Fork 0
Code Activity

Bug fix for the issue #1497. JSBSim calculations of geodetic coordinates were producing a NaN at the North and South poles (i.e latitude +/-90deg).

Browse source
This commit is contained in:
bcoconni 2014-08-03 13:59:30 +02:00
parent c430cc7b7d
commit 1c867eb99d
1 changed files with 9 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

10
src/FDM/JSBSim/math/FGLocation.cpp
View file

@ -419,7 +419,15 @@ void FGLocation::ComputeDerivedUnconditional(void) const
z = signz0*sqrt_q*(w+sqrt(z_term));
}
Ne = a*sqrt(1+eps2*z*z/b2);
mGeodLat = asin((eps2+1.0)*(z/Ne));
double tmp = (eps2+1.0)*(z/Ne);
// Ugly hack to work around the round-off errors when the simulation is
// started at a latitude of 90deg.
if (tmp > 1.0)
tmp = 1.0;
else if (tmp < -1.0)
tmp = -1.0;
// End of ugly hack
mGeodLat = asin(tmp);
r0 = rxy;
GeodeticAltitude = r0*cos(mGeodLat) + mECLoc(eZ)*sin(mGeodLat) - a2/Ne;
}