* Adapted from algebra3 by Jean-Francois Doue, started October 1998.
*/
-// Copyright (C) 1998 Curtis L. Olson - curt@me.umn.edu
+// Copyright (C) 1998 Curtis L. Olson - http://www.flightgear.org/~curt
//
// This library is free software; you can redistribute it and/or
// modify it under the terms of the GNU Library General Public
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
// Library General Public License for more details.
//
-// You should have received a copy of the GNU Library General Public
-// License along with this library; if not, write to the
-// Free Software Foundation, Inc., 59 Temple Place - Suite 330,
-// Boston, MA 02111-1307, USA.
+// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
// $Id$
#define _POINT3D_HXX
-#ifndef __cplusplus
+#ifndef __cplusplus
# error This library requires C++
-#endif
-
-#include <simgear/compiler.h>
-
-#ifdef SG_MATH_EXCEPTION_CLASH
-# define exception c_exception
#endif
-#ifdef SG_HAVE_STD_INCLUDES
-# include <iostream>
-# include <cassert>
-# include <cmath>
-#else
-# include <iostream.h>
-# include <assert.h>
-# include <math.h>
-#endif
-
-#include <simgear/math/localconsts.hxx>
-
-// I don't understand ... <math.h> or <cmath> should be included
-// already depending on how you defined SG_HAVE_STD_INCLUDES, but I
-// can go ahead and add this -- CLO
-#ifdef __MWERKS__
-SG_USING_NAMESPACE(std);
-#endif
+#include <simgear/compiler.h>
-SG_USING_STD(ostream);
-SG_USING_STD(istream);
+#include <ostream>
+#include <istream>
+#include <cassert>
+#include <cmath>
+#include "SGMath.hxx"
const double fgPoint3_Epsilon = 0.0000001;
// Kludge for msvc++ 6.0 - requires forward decls of friend functions.
class Point3D;
-istream& operator>> ( istream&, Point3D& );
-ostream& operator<< ( ostream&, const Point3D& );
+std::istream& operator>> ( std::istream&, Point3D& );
+std::ostream& operator<< ( std::ostream&, const Point3D& );
Point3D operator- (const Point3D& p); // -p1
bool operator== (const Point3D& a, const Point3D& b); // p1 == p2?
explicit Point3D(const double d);
Point3D(const Point3D &p);
+ static Point3D fromSGGeod(const SGGeod& geod);
+ static Point3D fromSGGeoc(const SGGeoc& geoc);
+ static Point3D fromSGVec3(const SGVec3<double>& cart);
+ static Point3D fromSGVec3(const SGVec3<float>& cart);
+ static Point3D fromSGVec2(const SGVec2<double>& cart);
+
// Assignment operators
Point3D& operator = ( const Point3D& p ); // assignment of a Point3D
double radius() const; // polar radius
double elev() const; // geodetic elevation (if specifying a surface point)
+ SGGeod toSGGeod(void) const;
+ SGGeoc toSGGeoc(void) const;
+
+ SGVec3d toSGVec3d(void) const;
+ SGVec3f toSGVec3f(void) const;
+ SGVec2f toSGVec2f(void) const;
+
// friends
friend Point3D operator - (const Point3D& p); // -p1
friend bool operator == (const Point3D& a, const Point3D& b); // p1 == p2?
- friend istream& operator>> ( istream&, Point3D& );
- friend ostream& operator<< ( ostream&, const Point3D& );
+ friend std::istream& operator>> ( std::istream&, Point3D& );
+ friend std::ostream& operator<< ( std::ostream&, const Point3D& );
// Special functions
double distance3D(const Point3D& a) const; // distance between
// input from stream
-inline istream&
-operator >> ( istream& in, Point3D& p)
+inline std::istream&
+operator >> ( std::istream& in, Point3D& p)
{
char c;
return in;
}
-inline ostream&
-operator<< ( ostream& out, const Point3D& p )
+inline std::ostream&
+operator<< ( std::ostream& out, const Point3D& p )
{
return out << p.n[PX] << ", " << p.n[PY] << ", " << p.n[PZ];
}
// CONSTRUCTORS
-inline Point3D::Point3D() {}
+inline Point3D::Point3D()
+{
+ n[PX] = n[PY] = 0.0;
+ n[PZ] = -9999.0;
+}
inline Point3D::Point3D(const double x, const double y, const double z)
{
n[PX] = p.n[PX]; n[PY] = p.n[PY]; n[PZ] = p.n[PZ];
}
+inline Point3D Point3D::fromSGGeod(const SGGeod& geod)
+{
+ Point3D pt;
+ pt.setlon(geod.getLongitudeRad());
+ pt.setlat(geod.getLatitudeRad());
+ pt.setelev(geod.getElevationM());
+ return pt;
+}
+
+inline Point3D Point3D::fromSGGeoc(const SGGeoc& geoc)
+{
+ Point3D pt;
+ pt.setlon(geoc.getLongitudeRad());
+ pt.setlat(geoc.getLatitudeRad());
+ pt.setradius(geoc.getRadiusM());
+ return pt;
+}
+
+inline Point3D Point3D::fromSGVec3(const SGVec3<double>& cart)
+{
+ Point3D pt;
+ pt.setx(cart.x());
+ pt.sety(cart.y());
+ pt.setz(cart.z());
+ return pt;
+}
+
+inline Point3D Point3D::fromSGVec3(const SGVec3<float>& cart)
+{
+ Point3D pt;
+ pt.setx(cart.x());
+ pt.sety(cart.y());
+ pt.setz(cart.z());
+ return pt;
+}
+
+inline Point3D Point3D::fromSGVec2(const SGVec2<double>& cart)
+{
+ Point3D pt;
+ pt.setx(cart.x());
+ pt.sety(cart.y());
+ pt.setz(0);
+ return pt;
+}
+
// ASSIGNMENT OPERATORS
inline Point3D& Point3D::operator = (const Point3D& p)
inline double Point3D::elev() const { return n[PZ]; }
+inline SGGeod Point3D::toSGGeod(void) const
+{
+ SGGeod geod;
+ geod.setLongitudeRad(lon());
+ geod.setLatitudeRad(lat());
+ geod.setElevationM(elev());
+ return geod;
+}
+
+inline SGGeoc Point3D::toSGGeoc(void) const
+{
+ SGGeoc geoc;
+ geoc.setLongitudeRad(lon());
+ geoc.setLatitudeRad(lat());
+ geoc.setRadiusM(radius());
+ return geoc;
+}
+
+inline SGVec3d Point3D::toSGVec3d(void) const
+{
+ return SGVec3d(x(), y(), z());
+}
+
+inline SGVec3f Point3D::toSGVec3f(void) const
+{
+ return SGVec3f(x(), y(), z());
+}
+
+inline SGVec2f Point3D::toSGVec2f(void) const
+{
+ return SGVec2f(x(), y());
+}
// FRIENDS
projects / simgear.git / blobdiff