//
// 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.
//
// $Id$
#include <stdio.h>
#include <string.h>
+#include <osgUtil/IntersectVisitor>
+
#include <simgear/debug/logstream.hxx>
#include <simgear/scene/tgdb/userdata.hxx>
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/scene/model/placementtrans.hxx>
+#include <simgear/scene/material/matlib.hxx>
+#include <simgear/scene/util/SGNodeMasks.hxx>
#include <Main/fg_props.hxx>
-#include "hitlist.hxx"
#include "scenery.hxx"
// Scenery Management system
-FGScenery::FGScenery() {
+FGScenery::FGScenery() :
+ center(0, 0, 0)
+{
SG_LOG( SG_TERRAIN, SG_INFO, "Initializing scenery subsystem" );
-
- center = Point3D(0.0);
}
void FGScenery::init() {
// Scene graph root
- scene_graph = new ssgRoot;
+ scene_graph = new osg::Group;
scene_graph->setName( "Scene" );
// Terrain branch
- terrain_branch = new ssgBranch;
+ terrain_branch = new osg::Group;
terrain_branch->setName( "Terrain" );
- scene_graph->addKid( terrain_branch );
+ scene_graph->addChild( terrain_branch.get() );
- models_branch = new ssgBranch;
+ models_branch = new osg::Group;
models_branch->setName( "Models" );
- scene_graph->addKid( models_branch );
+ scene_graph->addChild( models_branch.get() );
- aircraft_branch = new ssgBranch;
+ aircraft_branch = new osg::Group;
aircraft_branch->setName( "Aircraft" );
- scene_graph->addKid( aircraft_branch );
+ scene_graph->addChild( aircraft_branch.get() );
// Lighting
- gnd_lights_root = new ssgRoot;
+ gnd_lights_root = new osg::Group;
gnd_lights_root->setName( "Ground Lighting Root" );
- vasi_lights_root = new ssgRoot;
+ vasi_lights_root = new osg::Group;
vasi_lights_root->setName( "VASI/PAPI Lighting Root" );
- rwy_lights_root = new ssgRoot;
+ rwy_lights_root = new osg::Group;
rwy_lights_root->setName( "Runway Lighting Root" );
- taxi_lights_root = new ssgRoot;
+ taxi_lights_root = new osg::Group;
taxi_lights_root->setName( "Taxi Lighting Root" );
// Initials values needed by the draw-time object loader
void FGScenery::unbind() {
}
-void FGScenery::set_center( Point3D p ) {
+void FGScenery::set_center( const SGVec3d& p ) {
+ if (center == p)
+ return;
center = p;
- sgdVec3 c;
- sgdSetVec3(c, p.x(), p.y(), p.z());
placement_list_type::iterator it = _placement_list.begin();
while (it != _placement_list.end()) {
- (*it)->setSceneryCenter(c);
+ (*it)->setSceneryCenter(center);
++it;
}
}
-void FGScenery::register_placement_transform(ssgPlacementTransform *trans) {
- trans->ref();
+void FGScenery::register_placement_transform(SGPlacementTransform *trans) {
_placement_list.push_back(trans);
- sgdVec3 c;
- sgdSetVec3(c, center.x(), center.y(), center.z());
- trans->setSceneryCenter(c);
+ trans->setSceneryCenter(center);
}
-void FGScenery::unregister_placement_transform(ssgPlacementTransform *trans) {
+void FGScenery::unregister_placement_transform(SGPlacementTransform *trans) {
placement_list_type::iterator it = _placement_list.begin();
while (it != _placement_list.end()) {
if ((*it) == trans) {
it = _placement_list.erase(it);
- ssgDeRefDelete(trans);
} else
++it;
}
bool
FGScenery::get_elevation_m(double lat, double lon, double max_alt,
- double& alt, bool exact)
+ double& alt, const SGMaterial** material,
+ bool exact)
{
-// std::cout << __PRETTY_FUNCTION__ << " "
-// << lat << " "
-// << lon << " "
-// << max_alt
-// << std::endl;
- sgdVec3 pos;
- sgGeodToCart(lat*SG_DEGREES_TO_RADIANS, lon*SG_DEGREES_TO_RADIANS,
- max_alt, pos);
- return get_cart_elevation_m(pos, 0, alt, exact);
+ SGGeod geod = SGGeod::fromDegM(lon, lat, max_alt);
+ SGVec3d pos = SGVec3d::fromGeod(geod);
+ return get_cart_elevation_m(pos, 0, alt, material, exact);
}
bool
-FGScenery::get_cart_elevation_m(const sgdVec3 pos, double max_altoff,
- double& alt, bool exact)
+FGScenery::get_cart_elevation_m(const SGVec3d& pos, double max_altoff,
+ double& alt, const SGMaterial** material,
+ bool exact)
{
- Point3D saved_center = center;
+ if ( norm1(pos) < 1 )
+ return false;
+
+ SGVec3d saved_center = center;
bool replaced_center = false;
if (exact) {
- Point3D ppos(pos[0], pos[1], pos[2]);
- if (30.0*30.0 < ppos.distance3Dsquared(center)) {
- set_center( ppos );
- replaced_center = false;
+ if (30*30 < distSqr(pos, center)) {
+ set_center( pos );
+ replaced_center = true;
}
}
- // overridden with actual values if a terrain intersection is
- // found
- double hit_radius = 0.0;
- sgdVec3 hit_normal = { 0.0, 0.0, 0.0 };
+
+ SGVec3d start = pos + max_altoff*normalize(pos) - center;
+ SGVec3d end = - center;
- bool hit = false;
- if ( fabs(pos[0]) > 1.0 || fabs(pos[1]) > 1.0 || fabs(pos[2]) > 1.0 ) {
- sgdVec3 sc;
- sgdSetVec3(sc, center[0], center[1], center[2]);
-
- sgdVec3 ncpos;
- sgdCopyVec3(ncpos, pos);
-
- FGHitList hit_list;
-
- // scenery center has been properly defined so any hit should
- // be valid (and not just luck)
- hit = fgCurrentElev(ncpos, max_altoff+sgdLengthVec3(pos),
- sc, (ssgTransform*)get_scene_graph(),
- &hit_list, &alt, &hit_radius, hit_normal);
+ osgUtil::IntersectVisitor intersectVisitor;
+ intersectVisitor.setTraversalMask(SG_NODEMASK_TERRAIN_BIT);
+ osg::ref_ptr<osg::LineSegment> lineSegment;
+ lineSegment = new osg::LineSegment(start.osg(), end.osg());
+ intersectVisitor.addLineSegment(lineSegment.get());
+ get_scene_graph()->accept(intersectVisitor);
+ bool hits = intersectVisitor.hits();
+ if (hits) {
+ int nHits = intersectVisitor.getNumHits(lineSegment.get());
+ alt = -SGLimitsd::max();
+ for (int i = 0; i < nHits; ++i) {
+ const osgUtil::Hit& hit
+ = intersectVisitor.getHitList(lineSegment.get())[i];
+ SGVec3d point;
+ point.osg() = hit.getWorldIntersectPoint();
+ point += center;
+ SGGeod geod = SGGeod::fromCart(point);
+ double elevation = geod.getElevationM();
+ if (alt < elevation) {
+ alt = elevation;
+ if (material)
+ *material = globals->get_matlib()->findMaterial(hit.getGeode());
+ }
+ }
}
if (replaced_center)
set_center( saved_center );
- return hit;
+ return hits;
}
+
+bool
+FGScenery::get_cart_ground_intersection(const SGVec3d& pos, const SGVec3d& dir,
+ SGVec3d& nearestHit, bool exact)
+{
+ // We assume that starting positions in the center of the earth are invalid
+ if ( norm1(pos) < 1 )
+ return false;
+
+ // Well that 'exactness' is somehow problematic, but makes at least sure
+ // that we don't compute that with a cenery center at the other side of
+ // the world ...
+ SGVec3d saved_center = center;
+ bool replaced_center = false;
+ if (exact) {
+ if (30*30 < distSqr(pos, center)) {
+ set_center( pos );
+ replaced_center = true;
+ }
+ }
+
+ // Make really sure the direction is normalized, is really cheap compared to
+ // computation of ground intersection.
+ SGVec3d start = pos - center;
+ SGVec3d end = start + 1e5*dir;
+
+ osgUtil::IntersectVisitor intersectVisitor;
+ intersectVisitor.setTraversalMask(SG_NODEMASK_TERRAIN_BIT);
+ osg::ref_ptr<osg::LineSegment> lineSegment;
+ lineSegment = new osg::LineSegment(start.osg(), end.osg());
+ intersectVisitor.addLineSegment(lineSegment.get());
+ get_scene_graph()->accept(intersectVisitor);
+ bool hits = intersectVisitor.hits();
+ if (hits) {
+ int nHits = intersectVisitor.getNumHits(lineSegment.get());
+ double dist = SGLimitsd::max();
+ for (int i = 0; i < nHits; ++i) {
+ const osgUtil::Hit& hit
+ = intersectVisitor.getHitList(lineSegment.get())[i];
+ SGVec3d point;
+ point.osg() = hit.getWorldIntersectPoint();
+ double newdist = length(start - point);
+ if (newdist < dist) {
+ dist = newdist;
+ nearestHit = point + center;
+ }
+ }
+ }
+
+ if (replaced_center)
+ set_center( saved_center );
+
+ return hits;
+}
+