Added beginnings of osgUtil::PlaneIntersector and osgSim::ElevationSlice

VisualStudio/osgSim/osgSim.dsp

@@ -167,6 +167,10 @@ SOURCE=..\..\src\osgSim\DOFTransform.cpp
 # End Source File
 # Begin Source File
 
+SOURCE=..\..\src\osgSim\ElevationSlice.cpp
+# End Source File
+# Begin Source File
+
 SOURCE=..\..\src\osgSim\HeightAboveTerrain.cpp
 # End Source File
 # Begin Source File
@@ -263,6 +267,10 @@ SOURCE=..\..\include\osgSim\HeightAboveTerrain
 # End Source File
 # Begin Source File
 
+SOURCE=..\..\include\osgSim\ElevationSlice
+# End Source File
+# Begin Source File
+
 SOURCE=..\..\Include\osgSim\Impostor
 # End Source File
 # Begin Source File

include/osgSim/ElevationSlice

@@ -0,0 +1,98 @@
+/* -*-c++-*- OpenSceneGraph - Copyright (C) 1998-2006 Robert Osfield 
+ *
+ * This library is open source and may be redistributed and/or modified under  
+ * the terms of the OpenSceneGraph Public License (OSGPL) version 0.0 or 
+ * (at your option) any later version.  The full license is in LICENSE file
+ * included with this distribution, and on the openscenegraph.org website.
+ * 
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the 
+ * OpenSceneGraph Public License for more details.
+*/
+
+#ifndef OSGSIM_ELEVATIONSLICE
+#define OSGSIM_ELEVATIONSLICE 1
+
+#include <osgUtil/IntersectionVisitor>
+
+// include so we can get access to the DatabaseCacheReadCallback
+#include <osgSim/LineOfSight>
+
+namespace osgSim {
+
+/** Helper class for setting up and aquiring height above terrain intersections with terrain.*/
+class OSGSIM_EXPORT ElevationSlice
+{
+    public :
+
+    
+        ElevationSlice();
+        
+        /** Set the start point of the slice.*/        
+        void setStartPoint(const osg::Vec3d& startPoint) { _startPoint = startPoint; }
+
+        /** Get the start point of the slice.*/        
+        const osg::Vec3d& getStartPoint() const { return _startPoint; }
+        
+        /** Set the end point of the slice.*/        
+        void setEndPoint(const osg::Vec3d& endPoint) { _endPoint = endPoint; }
+
+        /** Get the end point of the slice.*/        
+        const osg::Vec3d& getEndPoint() const { return _endPoint; }
+
+        
+        typedef std::vector<osg::Vec3d> Vec3dList;
+        
+        /** Get the intersections in the form of a vector of Vec3d. */
+        const Vec3dList& getIntersections() const  { return _intersections; }
+
+        typedef std::pair<double,double> DistanceHeight;
+        typedef std::vector<DistanceHeight> DistanceHeightList;
+        
+        /** Get the intersections in the form a vector of pair<double,double> representing distance along the slice and height. */
+        const DistanceHeightList& getDistanceHeightIntersections() const { return _distanceHeightIntersections; }
+        
+       
+        /** Compute the intersections with the specified scene graph, the results are stored in vectors of Vec3d.
+          * Note, if the topmost node is a CoordinateSystemNode then the input points are assumed to be geocentric,
+          * with the up vector defined by the EllipsoidModel attached to the CoordinateSystemNode.
+          * If the topmost node is not a CoordinateSystemNode then a local coordinates frame is assumed, with a local up vector. */
+        void computeIntersections(osg::Node* scene);
+
+        /** Compute the vertical distance between the specified scene graph and a single HAT point. .*/
+        static Vec3dList computeElevationSlice(osg::Node* scene, const osg::Vec3d& startPoint, const osg::Vec3d& endPoint);
+        
+        
+        /** Clear the database cache.*/
+        void clearDatabaseCache() { if (_dcrc.valid()) _dcrc->clearDatabaseCache(); }
+
+        /** Set the ReadCallback that does the reading of external PagedLOD models, and caching of loaded subgraphs.
+          * Note, if you have mulitple LineOfSight or ElevationSlice objects in use at one time then you should share a single
+          * DatabaseCacheReadCallback between all of them. */
+        void setDatabaseCacheReadCallback(DatabaseCacheReadCallback* dcrc);
+
+        /** Get the ReadCallback that does the reading of external PagedLOD models, and caching of loaded subgraphs.*/
+        DatabaseCacheReadCallback* getDatabaseCacheReadCallback() { return _dcrc.get(); }
+        
+        /** Get the IntersectionVistor that does the intersection traversal over the scene.
+          * Note, if you want to customized the traversal then you can use the IntersectionVisitor's method to alter its behavior. */
+        osgUtil::IntersectionVisitor& getIntersectionVisitor() { return _intersectionVisitor; }
+
+    protected :
+    
+    
+        osg::Vec3d                              _startPoint;
+        osg::Vec3d                              _endPoint;
+        Vec3dList                               _intersections;
+        DistanceHeightList                      _distanceHeightIntersections;
+        
+        osg::ref_ptr<DatabaseCacheReadCallback> _dcrc;
+        osgUtil::IntersectionVisitor            _intersectionVisitor;
+
+
+};
+
+}
+
+#endif

include/osgUtil/IntersectionVisitor

@@ -215,6 +215,67 @@ class OSGUTIL_EXPORT PolytopeIntersector : public Intersector
     
 };
 
+/** Concrent class for implementing polytope intersections with the scene graph.
+  * To be used in conjunction with IntersectionVisitor. */
+class OSGUTIL_EXPORT PlaneIntersector : public Intersector
+{
+    public:
+    
+        /** Construct a PolytopeIntersector using speified polytope in MODEL coordinates.*/
+        PlaneIntersector(const osg::Plane& plane, const osg::Polytope& boundingPolytope=osg::Polytope());
+        
+        /** Construct a PolytopeIntersector using speified polytope in specified coordinate frame.*/
+        PlaneIntersector(CoordinateFrame cf, const osg::Plane& plane, const osg::Polytope& boundingPolytope=osg::Polytope());
+
+        struct Intersection
+        {
+            Intersection() {}
+        
+            bool operator < (const Intersection& rhs) const
+            {
+                if (nodePath < rhs.nodePath) return true;
+                if (rhs.nodePath < nodePath ) return false;
+                return (drawable < rhs.drawable);
+            }
+
+            osg::NodePath                   nodePath;
+            osg::ref_ptr<osg::Drawable>     drawable;
+        };
+        
+        typedef std::set<Intersection> Intersections;
+        
+        inline void insertIntersection(const Intersection& intersection) { getIntersections().insert(intersection); }
+
+        inline Intersections& getIntersections() { return _parent ? _parent->_intersections : _intersections; }
+
+        inline Intersection getFirstIntersection() { Intersections& intersections = getIntersections(); return intersections.empty() ? Intersection() : *(intersections.begin()); }
+
+    public:
+
+        virtual Intersector* clone(osgUtil::IntersectionVisitor& iv);
+        
+        virtual bool enter(const osg::Node& node);
+        
+        virtual void leave();
+        
+        virtual void intersect(osgUtil::IntersectionVisitor& iv, osg::Drawable* drawable);
+        
+        virtual void reset();
+
+        virtual bool containsIntersections() { return !_intersections.empty(); }
+
+    protected:
+
+        PlaneIntersector*   _parent;
+
+        osg::Plane          _plane;
+        osg::Polytope       _polytope;
+        
+        Intersections       _intersections;
+    
+};
+
+
 /** Concrent class for passing multiple intersectors through the scene graph.
   * To be used in conjunction with IntersectionVisitor. */
 class OSGUTIL_EXPORT IntersectorGroup : public Intersector

src/osgSim/ElevationSlice.cpp

@@ -0,0 +1,84 @@
+/* -*-c++-*- OpenSceneGraph - Copyright (C) 1998-2006 Robert Osfield 
+ *
+ * This library is open source and may be redistributed and/or modified under  
+ * the terms of the OpenSceneGraph Public License (OSGPL) version 0.0 or 
+ * (at your option) any later version.  The full license is in LICENSE file
+ * included with this distribution, and on the openscenegraph.org website.
+ * 
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the 
+ * OpenSceneGraph Public License for more details.
+*/
+
+#include <osg/CoordinateSystemNode>
+#include <osgSim/ElevationSlice>
+
+#include <osg/Notify>
+
+using namespace osgSim;
+
+ElevationSlice::ElevationSlice()
+{
+    setDatabaseCacheReadCallback(new DatabaseCacheReadCallback);
+}
+
+void ElevationSlice::computeIntersections(osg::Node* scene)
+{
+    osg::CoordinateSystemNode* csn = dynamic_cast<osg::CoordinateSystemNode*>(scene);
+    osg::EllipsoidModel* em = csn ? csn->getEllipsoidModel() : 0;
+
+
+    osg::Plane plane;
+    osg::Polytope boundingPolytope;
+
+    if (em)
+    {
+
+        osg::Vec3d upVector = em->computeLocalUpVector(_startPoint.x(), _startPoint.y(), _startPoint.z());
+
+        double latitude, longitude, height;
+        em->convertXYZToLatLongHeight(_startPoint.x(), _startPoint.y(), _startPoint.z(), latitude, longitude, height);
+
+        osg::notify(osg::NOTICE)<<"lat = "<<latitude<<" longitude = "<<longitude<<" height = "<<height<<std::endl;
+
+    }
+    else
+    {
+        osg::Vec3d upVector (0.0, 0.0, 1.0);
+
+    }
+    
+    osg::ref_ptr<osgUtil::PlaneIntersector> intersector = new osgUtil::PlaneIntersector(plane, boundingPolytope);
+
+    _intersectionVisitor.reset();
+    _intersectionVisitor.setIntersector( intersector.get() );
+    
+    scene->accept(_intersectionVisitor);
+    
+    osgUtil::PlaneIntersector::Intersections& intersections = intersector->getIntersections();
+    if (!intersections.empty())
+    {
+        osg::notify(osg::NOTICE)<<"Got intersections."<<std::endl;
+    }
+    else
+    {
+        osg::notify(osg::NOTICE)<<"No intersections found."<<std::endl;
+    }
+    
+}
+
+ElevationSlice::Vec3dList ElevationSlice::computeElevationSlice(osg::Node* scene, const osg::Vec3d& startPoint, const osg::Vec3d& endPoint)
+{
+    ElevationSlice es;
+    es.setStartPoint(startPoint);
+    es.setEndPoint(endPoint);
+    es.computeIntersections(scene);
+    return es.getIntersections();
+}
+
+void ElevationSlice::setDatabaseCacheReadCallback(DatabaseCacheReadCallback* dcrc)
+{
+    _dcrc = dcrc;
+    _intersectionVisitor.setReadCallback(dcrc);
+}

src/osgSim/GNUmakefile

@@ -15,6 +15,7 @@ CXXFILES = \
 	LightPointNode.cpp\
 	LineOfSight.cpp\
 	HeightAboveTerrain.cpp\
+	ElevationSlice.cpp\
 	MultiSwitch.cpp\
 	OverlayNode.cpp\
 	OpenFlightOptimizer.cpp\

src/osgUtil/IntersectionVisitor.cpp

@@ -512,7 +512,7 @@ bool LineSegmentIntersector::intersectAndClip(osg::Vec3d& s, osg::Vec3d& e,const
 
 ///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
 //
-//  IntersectorGroup
+//  PolytopeIntersector
 //
 PolytopeIntersector::PolytopeIntersector(const osg::Polytope& polytope):
     _parent(0),
@@ -629,6 +629,105 @@ void PolytopeIntersector::reset()
 
 
 
+///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
+//
+//  PlaneIntersector
+//
+PlaneIntersector::PlaneIntersector(const osg::Plane& plane, const osg::Polytope& boundingPolytope):
+    _parent(0),
+    _plane(plane),
+    _polytope(boundingPolytope)
+{
+}
+
+PlaneIntersector::PlaneIntersector(CoordinateFrame cf, const osg::Plane& plane, const osg::Polytope& boundingPolytope):
+    Intersector(cf),
+    _parent(0),
+    _plane(plane),
+    _polytope(boundingPolytope)
+{
+}
+
+Intersector* PlaneIntersector::clone(osgUtil::IntersectionVisitor& iv)
+{
+    if (_coordinateFrame==MODEL && iv.getModelMatrix()==0)
+    {
+        osg::ref_ptr<PlaneIntersector> pi = new PlaneIntersector(_plane, _polytope);
+        pi->_parent = this;
+        return pi.release();
+    }
+
+    // compute the matrix that takes this Intersector from its CoordinateFrame into the local MODEL coordinate frame
+    // that geometry in the scene graph will always be in.
+    osg::Matrix matrix;
+    switch (_coordinateFrame)
+    {
+        case(WINDOW): 
+            if (iv.getWindowMatrix()) matrix.preMult( *iv.getWindowMatrix() );
+            if (iv.getProjectionMatrix()) matrix.preMult( *iv.getProjectionMatrix() );
+            if (iv.getViewMatrix()) matrix.preMult( *iv.getViewMatrix() );
+            if (iv.getModelMatrix()) matrix.preMult( *iv.getModelMatrix() );
+            break;
+        case(PROJECTION): 
+            if (iv.getProjectionMatrix()) matrix.preMult( *iv.getProjectionMatrix() );
+            if (iv.getViewMatrix()) matrix.preMult( *iv.getViewMatrix() );
+            if (iv.getModelMatrix()) matrix.preMult( *iv.getModelMatrix() );
+            break;
+        case(VIEW): 
+            if (iv.getViewMatrix()) matrix.preMult( *iv.getViewMatrix() );
+            if (iv.getModelMatrix()) matrix.preMult( *iv.getModelMatrix() );
+            break;
+        case(MODEL):
+            if (iv.getModelMatrix()) matrix = *iv.getModelMatrix();
+            break;
+    }
+
+    osg::Plane plane = _plane;
+    plane.transformProvidingInverse(matrix);
+
+    osg::Polytope transformedPolytope;
+    transformedPolytope.setAndTransformProvidingInverse(_polytope, matrix);
+
+    osg::ref_ptr<PlaneIntersector> pi = new PlaneIntersector(plane, transformedPolytope);
+    pi->_parent = this;
+    return pi.release();
+}
+
+bool PlaneIntersector::enter(const osg::Node& node)
+{
+    return !node.isCullingActive() ||
+           ( _plane.intersect(node.getBound()) && _polytope.contains(node.getBound()) );
+}
+
+
+void PlaneIntersector::leave()
+{
+    // do nothing.
+}
+
+
+void PlaneIntersector::intersect(osgUtil::IntersectionVisitor& iv, osg::Drawable* drawable)
+{
+    if ( !_plane.intersect( drawable->getBound() ) ) return;
+    if ( !_polytope.contains( drawable->getBound() ) ) return;
+
+    Intersection hit;
+    hit.nodePath = iv.getNodePath();
+    hit.drawable = drawable;
+    
+    insertIntersection(hit);
+}
+
+
+void PlaneIntersector::reset()
+{
+    Intersector::reset();
+    
+    _intersections.clear();
+}
+
+
+
 ///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
 //
 //  IntersectorGroup