//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
-// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
+
+#ifdef HAVE_CONFIG_H
+# include <config.h>
+#endif
+
+#include <sstream>
#include <math.h>
#include <simgear/math/point3d.hxx>
#include "ATCutils.hxx"
#include "ATCProjection.hxx"
+static const string nums[10] = {"zero", "one", "two", "three", "four", "five", "six", "seven", "eight", "niner"};
+
// Convert any number to spoken digits
-string ConvertNumToSpokenDigits(string n) {
+string ConvertNumToSpokenDigits(const string &n) {
//cout << "n = " << n << endl;
- string nums[10] = {"zero", "one", "two", "three", "four", "five", "six", "seven", "eight", "nine"};
- string pt = "decimal";
+ static const string pt = "decimal";
string str = "";
for(unsigned int i=0; i<n.length(); ++i) {
// Convert an integer to spoken digits
string ConvertNumToSpokenDigits(int n) {
- char buf[12]; // should be big enough!!
- sprintf(buf, "%i", n);
- string tempstr1 = buf;
- return(ConvertNumToSpokenDigits(tempstr1));
+ std::ostringstream buf;
+ buf << n;
+ return(ConvertNumToSpokenDigits(buf.str()));
}
// Convert a 2 digit rwy number to a spoken-style string
string ConvertRwyNumToSpokenString(int n) {
- string nums[10] = {"zero", "one", "two", "three", "four", "five", "six", "seven", "eight", "nine"};
// Basic error/sanity checking
while(n < 0) {
n += 36;
// Assumes we get a two-digit string optionally appended with L, R or C
// eg 01 07L 29R 36
// Anything else is not guaranteed to be handled correctly!
-string ConvertRwyNumToSpokenString(string s) {
+string ConvertRwyNumToSpokenString(const string &s) {
if(s.size() < 3) {
return(ConvertRwyNumToSpokenString(atoi(s.c_str())));
} else {
//================================================================================================================
// Given two positions (lat & lon in degrees), get the HORIZONTAL separation (in meters)
-double dclGetHorizontalSeparation(Point3D pos1, Point3D pos2) {
+double dclGetHorizontalSeparation(const Point3D& pos1, const Point3D& pos2) {
double x; //East-West separation
double y; //North-South separation
double z; //Horizontal separation - z = sqrt(x^2 + y^2)
// Given a position (lat/lon/elev), heading and vertical angle (degrees), and distance (meters), calculate the new position.
// This function assumes the world is spherical. If geodetic accuracy is required use the functions is sg_geodesy instead!
// Assumes that the ground is not hit!!! Expects heading and angle in degrees, distance in meters.
-Point3D dclUpdatePosition(Point3D pos, double heading, double angle, double distance) {
+Point3D dclUpdatePosition(const Point3D& pos, double heading, double angle, double distance) {
//cout << setprecision(10) << pos.lon() << ' ' << pos.lat() << '\n';
heading *= DCL_DEGREES_TO_RADIANS;
angle *= DCL_DEGREES_TO_RADIANS;
// Get a heading in degrees from one lat/lon to another.
// This function assumes the world is spherical. If geodetic accuracy is required use the functions is sg_geodesy instead!
-// Warning - at the moment we are not checking for identical points - currently it returns 90 in this instance.
-double GetHeadingFromTo(Point3D A, Point3D B) {
+// Warning - at the moment we are not checking for identical points - currently it returns 0 in this instance.
+double GetHeadingFromTo(const Point3D& A, const Point3D& B) {
double latA = A.lat() * DCL_DEGREES_TO_RADIANS;
double lonA = A.lon() * DCL_DEGREES_TO_RADIANS;
double latB = B.lat() * DCL_DEGREES_TO_RADIANS;
double lonB = B.lon() * DCL_DEGREES_TO_RADIANS;
double xdist = sin(lonB - lonA) * (double)SG_EQUATORIAL_RADIUS_M * cos((latA+latB)/2.0);
double ydist = sin(latB - latA) * (double)SG_EQUATORIAL_RADIUS_M;
-
- if(xdist >= 0) {
- if(ydist > 0) {
- return(atan(xdist/ydist) * DCL_RADIANS_TO_DEGREES);
- } else if (ydist == 0) {
- return(90.0);
- } else {
- return(180.0 - atan(xdist/fabs(ydist)) * DCL_RADIANS_TO_DEGREES);
- }
- } else {
- if(ydist > 0) {
- return(360.0 - atan(fabs(xdist)/ydist) * DCL_RADIANS_TO_DEGREES);
- } else if (ydist == 0) {
- return(270.0);
- } else {
- return(180.0 + atan(xdist/ydist) * DCL_RADIANS_TO_DEGREES);
- }
- }
+ double heading = atan2(xdist, ydist) * DCL_RADIANS_TO_DEGREES;
+ return heading < 0.0 ? heading + 360 : heading;
}
// Given a heading (in degrees), bound it from 0 -> 360
return a3;
}
-//================================================================================================================
-
-// Airport stuff. The next two functions are straight copies of their fg.... equivalents
-// in fg_init.cxx, and are just here temporarily until some rationalisation occurs.
-// find basic airport location info from airport database
-bool dclFindAirportID( const string& id, FGAirport *a ) {
- FGAirport result;
-
- if ( id.length() ) {
- SG_LOG( SG_GENERAL, SG_INFO, "Searching for airport code = " << id );
-
- result = globals->get_airports()->search( id );
- if ( result.id.empty() ) {
- SG_LOG( SG_GENERAL, SG_ALERT,
- "Failed to find " << id << " in basic.dat.gz" );
- return false;
- }
- } else {
- return false;
- }
-
- *a = result;
-
- SG_LOG( SG_GENERAL, SG_INFO,
- "Position for " << id << " is ("
- << a->longitude << ", "
- << a->latitude << ")" );
-
- return true;
-}
-
-// get airport elevation
-double dclGetAirportElev( const string& id ) {
- FGAirport a;
- // double lon, lat;
-
- SG_LOG( SG_ATC, SG_INFO,
- "Finding elevation for airport: " << id );
-
- if ( dclFindAirportID( id, &a ) ) {
- return a.elevation * SG_FEET_TO_METER;
- } else {
- return -9999.0;
- }
-}
-
-// get airport position
-Point3D dclGetAirportPos( const string& id ) {
- FGAirport a;
- // double lon, lat;
-
- SG_LOG( SG_ATC, SG_INFO,
- "Finding position for airport: " << id );
-
- if ( dclFindAirportID( id, &a ) ) {
- return Point3D(a.longitude, a.latitude, a.elevation);
- } else {
- return Point3D(0.0, 0.0, -9999.0);
- }
-}
-
// Runway stuff
// Given a Point3D (lon/lat/elev) and an FGRunway struct, determine if the point lies on the runway
-bool OnRunway(Point3D pt, const FGRunway& rwy) {
+bool OnRunway(const Point3D& pt, const FGRunway& rwy) {
FGATCAlignedProjection ortho;
- Point3D centre(rwy.lon, rwy.lat, 0.0); // We don't need the elev
- ortho.Init(centre, rwy.heading);
+ Point3D centre(rwy._lon, rwy._lat, 0.0); // We don't need the elev
+ ortho.Init(centre, rwy._heading);
Point3D xyc = ortho.ConvertToLocal(centre);
Point3D xyp = ortho.ConvertToLocal(pt);
//cout << "Length offset = " << fabs(xyp.y() - xyc.y()) << '\n';
//cout << "Width offset = " << fabs(xyp.x() - xyc.x()) << '\n';
- if((fabs(xyp.y() - xyc.y()) < ((rwy.length/2.0) + 5.0))
- && (fabs(xyp.x() - xyc.x()) < (rwy.width/2.0))) {
+ if((fabs(xyp.y() - xyc.y()) < ((rwy._length/2.0) + 5.0))
+ && (fabs(xyp.x() - xyc.x()) < (rwy._width/2.0))) {
return(true);
}
projects / flightgear.git / blobdiff