#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 <simgear/scene/util/SGSceneUserData.hxx>
#include <Main/fg_props.hxx>
-#include "hitlist.hxx"
#include "scenery.hxx"
+class FGGroundPickCallback : public SGPickCallback {
+public:
+ virtual bool buttonPressed(int button, const Info& info)
+ {
+ // only on left mouse button
+ if (button != 0)
+ return false;
+
+ SGGeod geod = SGGeod::fromCart(info.wgs84);
+ SG_LOG( SG_TERRAIN, SG_INFO, "Got ground pick at " << geod );
+
+ SGPropertyNode *c = fgGetNode("/sim/input/click", true);
+ c->setDoubleValue("longitude-deg", geod.getLongitudeDeg());
+ c->setDoubleValue("latitude-deg", geod.getLatitudeDeg());
+ c->setDoubleValue("elevation-m", geod.getElevationM());
+ c->setDoubleValue("elevation-ft", geod.getElevationFt());
+ fgSetBool("/sim/signals/click", 1);
+
+ return true;
+ }
+};
// Scenery Management system
-FGScenery::FGScenery() :
- center(0, 0, 0)
+FGScenery::FGScenery()
{
SG_LOG( SG_TERRAIN, SG_INFO, "Initializing scenery subsystem" );
}
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() );
+ SGSceneUserData* userData;
+ userData = SGSceneUserData::getOrCreateSceneUserData(terrain_branch.get());
+ userData->setPickCallback(new FGGroundPickCallback);
- 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 );
-
- // Lighting
- gnd_lights_root = new ssgRoot;
- gnd_lights_root->setName( "Ground Lighting Root" );
-
- vasi_lights_root = new ssgRoot;
- vasi_lights_root->setName( "VASI/PAPI Lighting Root" );
-
- rwy_lights_root = new ssgRoot;
- rwy_lights_root->setName( "Runway Lighting Root" );
-
- taxi_lights_root = new ssgRoot;
- taxi_lights_root->setName( "Taxi Lighting Root" );
+ scene_graph->addChild( aircraft_branch.get() );
// Initials values needed by the draw-time object loader
sgUserDataInit( globals->get_model_lib(), globals->get_fg_root(),
void FGScenery::unbind() {
}
-void FGScenery::set_center( const SGVec3d& p ) {
- if (center == p)
- return;
- center = p;
- placement_list_type::iterator it = _placement_list.begin();
- while (it != _placement_list.end()) {
- (*it)->setSceneryCenter(center.sg());
- ++it;
- }
-}
-
-void FGScenery::register_placement_transform(ssgPlacementTransform *trans) {
- _placement_list.push_back(trans);
- trans->setSceneryCenter(center.sg());
-}
-
-void FGScenery::unregister_placement_transform(ssgPlacementTransform *trans) {
- placement_list_type::iterator it = _placement_list.begin();
- while (it != _placement_list.end()) {
- if ((*it) == trans) {
- it = _placement_list.erase(it);
- } else
- ++it;
- }
-}
-
bool
FGScenery::get_elevation_m(double lat, double lon, double max_alt,
- double& alt, const SGMaterial** material,
- bool exact)
+ double& alt, const SGMaterial** material)
{
SGGeod geod = SGGeod::fromDegM(lon, lat, max_alt);
SGVec3d pos = SGVec3d::fromGeod(geod);
- return get_cart_elevation_m(pos, 0, alt, material, exact);
+ return get_cart_elevation_m(pos, 0, alt, material);
}
bool
FGScenery::get_cart_elevation_m(const SGVec3d& pos, double max_altoff,
- double& alt, const SGMaterial** material,
- bool exact)
+ double& alt, const SGMaterial** material)
{
if ( norm1(pos) < 1 )
return false;
- SGVec3d saved_center = center;
- bool replaced_center = false;
- if (exact) {
- if (30*30 < distSqr(pos, center)) {
- set_center( pos );
- replaced_center = true;
- }
- }
-
- // overridden with actual values if a terrain intersection is
- // found
- int this_hit;
- double hit_radius = 0.0;
- SGVec3d hit_normal(0, 0, 0);
+ SGVec3d start = pos + max_altoff*normalize(pos);
+ SGVec3d end(0, 0, 0);
- SGVec3d sc = center;
- SGVec3d ncpos = pos;
-
- FGHitList hit_list;
- // scenery center has been properly defined so any hit should
- // be valid (and not just luck)
- bool hit = fgCurrentElev(ncpos.sg(), max_altoff+length(pos), sc.sg(),
- get_scene_graph(), &hit_list, &alt,
- &hit_radius, hit_normal.sg(), this_hit);
-
- if (material) {
- *material = 0;
- if (hit) {
- ssgEntity *entity = hit_list.get_entity( this_hit );
- if (entity && entity->isAKindOf(ssgTypeLeaf())) {
- ssgLeaf* leaf = static_cast<ssgLeaf*>(entity);
- *material = globals->get_matlib()->findMaterial(leaf);
+ 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();
+ SGGeod geod = SGGeod::fromCart(point);
+ double elevation = geod.getElevationM();
+ if (alt < elevation) {
+ alt = elevation;
+ if (material) {
+ const osg::StateSet* stateSet = hit.getDrawable()->getStateSet();
+ *material = globals->get_matlib()->findMaterial(stateSet);
+ }
}
}
}
- 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)
+ SGVec3d& nearestHit)
{
// 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;
- }
- }
-
- // Not yet found any hit ...
- bool result = false;
-
// Make really sure the direction is normalized, is really cheap compared to
// computation of ground intersection.
- SGVec3d normalizedDir = normalize(dir);
- SGVec3d relativePos = pos - center;
-
- // At the moment only intersection with the terrain?
- FGHitList hit_list;
- hit_list.Intersect(globals->get_scenery()->get_terrain_branch(),
- relativePos.sg(), normalizedDir.sg());
-
- double dist = DBL_MAX;
- int hitcount = hit_list.num_hits();
- for (int i = 0; i < hitcount; ++i) {
- // Check for the nearest hit
- SGVec3d diff = SGVec3d(hit_list.get_point(i)) - relativePos;
-
- // We only want hits in front of us ...
- if (dot(normalizedDir, diff) < 0)
- continue;
-
- // find the nearest hit
- double nDist = dot(diff, diff);
- if (dist < nDist)
- continue;
-
- // Store the hit point
- dist = nDist;
- nearestHit = SGVec3d(hit_list.get_point(i)) + center;
- result = true;
+ SGVec3d start = pos;
+ SGVec3d end = start + 1e5*normalize(dir); // FIXME visibility ???
+
+ 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;
+ }
+ }
}
- if (replaced_center)
- set_center( saved_center );
-
- return result;
+ return hits;
}
-