#pragma ident "$Id$"/** * @file positiontest.cpp  Test the Position module * */#include <iostream>#include <iomanip>#include "Position.hpp"using namespace std;using namespace gpstk;using namespace gpstk::StringUtils;int main(){   try   {      int i;      Position c,s,d,g;      cout << "Position() " << c << endl;      // test transformTo      cout << "Test set...() and transformTo\n";      {         c.setECEF(-1575232.0141,-4707872.2332, 3993198.4383);         cout << "Position.set        to Cartesian  " << c << endl;         Position t(c);         t.transformTo(Position::Geodetic);         cout << "Transform Cartesian to Geodetic   " << t;         cout << "  Error : " << range(t,c) << " m" << endl;         t = c;         t.transformTo(Position::Geocentric);         cout << "Transform Cartesian to Geocentric " << t;         cout << "  Error : " << range(t,c) << " m" << endl;         t = c;         t.transformTo(Position::Spherical);         cout << "Transform Cartesian to Spherical  " << t;         cout << "  Error : " << range(t,c) << " m" << endl;      }      {         d.setGeodetic(39.000004186778,251.499999999370,1400.009066903964);         cout << "Position.set         to Geodetic  " << d << endl;         Position t(d);         t.transformTo(Position::Cartesian);         cout << "Transform Geodetic to Cartesian   " << t;         cout << "  Error : " << range(t,d) << " m" << endl;         t = d;         t.transformTo(Position::Geocentric);         cout << "Transform Geodetic to Geocentric  " << t;         cout << "  Error : " << range(t,d) << " m" << endl;         t = d;         t.transformTo(Position::Spherical);         cout << "Transform Geodetic to Spherical   " << t;         cout << "  Error : " << range(t,d) << " m" << endl;      }      {         g.setGeocentric(38.811958506159,251.499999999370,6371110.627671023800);         cout << "Position.set        to Geocentric " << g << endl;         Position t(g);         t.transformTo(Position::Cartesian);         cout << "Transform Geocentric to Cartesian " << t;         cout << "  Error : " << range(t,g) << " m" << endl;         t = g;         t.transformTo(Position::Geodetic);         cout << "Transform Geocentric to Geodetic  " << t;         cout << "  Error : " << range(t,g) << " m" << endl;         t = g;         t.transformTo(Position::Spherical);         cout << "Transform Geocentric to Spherical " << t;         cout << "  Error : " << range(t,g) << " m" << endl;      }      {         s.setSpherical(51.188041493841,251.499999999370,6371110.627671023800);         cout << "Position.set      to Spherical    " << s << endl;         Position t(s);         t.transformTo(Position::Cartesian);         cout << "Transform Spherical to Cartesian  " << t;         cout << "  Error : " << range(t,s) << " m" << endl;         t = s;         t.transformTo(Position::Geocentric);         cout << "Transform Spherical to Geocentric " << t;         cout << "  Error : " << range(t,s) << " m" << endl;         t = s;         t.transformTo(Position::Geodetic);         cout << "Transform Spherical to Geodetic   " << t;         cout << "  Error : " << range(t,s) << " m" << endl;      }      // test printf      cout << "\nTest printf and the indicated 'get()' functions\n";      cout << c.printf("%13.4x     X() (meters)") << endl;      cout << c.printf("%13.4y     Y() (meters)") << endl;      cout << c.printf("%13.4z     Z() (meters)") << endl;      cout << c.printf("%13.4X     X()/1000 (kilometers)") << endl;      cout << c.printf("%13.4Y     Y()/1000 (kilometers)") << endl;      cout << c.printf("%13.4Z     Z()/1000 (kilometers)") << endl;      cout << c.printf("%15.6A   geodeticLatitude() (degrees North)") << endl;      cout << c.printf("%15.6a   geocentricLatitude() (degrees North)") << endl;      cout << c.printf("%15.6L   longitude() (degrees East)") << endl;      cout << c.printf("%15.6l   longitude() (degrees East)") << endl;      cout << c.printf("%15.6w   longitude() (degrees West)") << endl;      cout << c.printf("%15.6W   longitude() (degrees West)") << endl;      cout << c.printf("%15.6t   theta() (degrees)") << endl;      cout << c.printf("%15.6T   theta() (radians)") << endl;      cout << c.printf("%15.6p   phi() (degrees)") << endl;      cout << c.printf("%15.6P   phi() (radians)") << endl;      cout << c.printf("%13.4r     radius() meters") << endl;      cout << c.printf("%13.4R     radius()/1000 kilometers") << endl;      cout << c.printf("%13.4h     height() meters") << endl;      cout << c.printf("%13.4H     height()/1000 kilometers") << endl;      // test setToString      cout << "\nTest setToString and equality operators\n";      string fmt[5]={         "",         "%A degN %L degE %h m",         "%a degN %L degE %r m",         "%x m %y m %z m",         "%t deg %p deg %r M"};      for(i=1; i<5; i++) {         string str;         Position t(c),tt;         t.transformTo(static_cast<Position::CoordinateSystem>(i));         {            ostringstream o;            o << t;            str = o.str();         }         tt.setToString(str,fmt[i]);         cout << "System: " << t.getSystemName() << endl;         cout << "Original    " << t << endl;         cout << "string      " << str << endl;         cout << "setToString " << tt            << " Error " << range(tt,t) << " m" << endl;         cout << " equality: " << (t==tt ? "==" : "not ==");         cout << " but " << (t!=tt ? "!=" : "not !=") << endl;         cout << endl;      }      // test elevation and azimuth      cout << "Elevation and azimth" << fixed << endl;      c.setECEF(-1575232.0141,-4707872.2332, 3993198.4383);      s.setECEF(3*6371110.62767,0,0);      cout << setw(6) << setprecision(2) << c.elevation(s)         << " " << setw(6) << setprecision(2) << c.azimuth(s) << endl;      // compare with functions from Triple::      cout << setw(6) << setprecision(2) << c.elvAngle(s)         << " " << setw(6) << setprecision(2) << c.azAngle(s) << endl;      cout << endl;      // test IPP      cout << "The IPP at " << g << " (90,0,350000) is\n"           << "           " << g.getIonosphericPiercePoint(90,0,350000)           << " " << g.getSystemName() << endl << endl;      // test ALL transforms with pole      // X -> D -> C -> S -> X -> C -> D -> X -> S -> D -> S -> C -> X      cout << "Try to break it at the pole\n";      c.setECEF(0,0,6371110.6277);      //c.setECEF(0,0,0.0001);         // this will break it      cout << "Set to the pole in cartesian : " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The pole in geodetic   " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The pole in geocentric " << c << endl;      c.transformTo(Position::Spherical);      cout << "The pole in spherical  " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The pole in cartesian  " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The pole in geocentric " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The pole in geodetic   " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The pole in cartesian  " << c << endl;      c.transformTo(Position::Spherical);      cout << "The pole in spherical  " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The pole in geodetic   " << c << endl;      c.transformTo(Position::Spherical);      cout << "The pole in spherical  " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The pole in geocentric " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The pole in cartesian  " << c << endl;      // test ALL transforms with origin      // X -> D -> C -> S -> X -> C -> D -> X -> S -> D -> S -> C -> X      cout << endl << "Try to break it at the origin\n";      c.setECEF(0,0,0);      cout << "Set to the origin in cartesian : " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The origin in geodetic   " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The origin in geocentric " << c << endl;      c.transformTo(Position::Spherical);      cout << "The origin in spherical  " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The origin in cartesian  " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The origin in geocentric " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The origin in geodetic   " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The origin in cartesian  " << c << endl;      c.transformTo(Position::Spherical);      cout << "The origin in spherical  " << c << endl;      c.transformTo(Position::Geodetic);      cout << "The origin in geodetic   " << c << endl;      c.transformTo(Position::Spherical);      cout << "The origin in spherical  " << c << endl;      c.transformTo(Position::Geocentric);      cout << "The origin in geocentric " << c << endl;      c.transformTo(Position::Cartesian);      cout << "The origin in cartesian  " << c << endl;      cout << "Tests complete." << endl;      return 0;   }   catch(gpstk::Exception& e)   {      cout << e << endl;   }   catch(...)   {      cout << "Some other exception thrown..." << endl;   }   cout << "Exiting with exceptions." << endl;   return -1;}