//
// 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 <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() {
+FGScenery::FGScenery()
+{
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() );
+ 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( Point3D p ) {
- 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;
- }
-}
-
-void FGScenery::register_placement_transform(ssgPlacementTransform *trans) {
- trans->ref();
- _placement_list.push_back(trans);
- sgdVec3 c;
- sgdSetVec3(c, center.x(), center.y(), center.z());
- trans->setSceneryCenter(c);
-}
-
-void FGScenery::unregister_placement_transform(ssgPlacementTransform *trans) {
- placement_list_type::iterator it = _placement_list.begin();
- while (it != _placement_list.end()) {
- if ((*it) == trans) {
- (*it)->deRef();
- it = _placement_list.erase(it);
- } else
- ++it;
- }
-}
-
bool
FGScenery::get_elevation_m(double lat, double lon, double max_alt,
- double& alt, bool exact)
+ double& alt, const SGMaterial** material)
{
-// 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);
}
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)
{
- Point3D 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 ( norm1(pos) < 1 )
+ return false;
+
+ SGVec3d start = pos + max_altoff*normalize(pos);
+ SGVec3d end(0, 0, 0);
+
+ 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);
+ }
+ }
}
}
- // overridden with actual values if a terrain intersection is
- // found
- double hit_radius = 0.0;
- sgdVec3 hit_normal = { 0.0, 0.0, 0.0 };
+ return hits;
+}
+
+bool
+FGScenery::get_cart_ground_intersection(const SGVec3d& pos, const SGVec3d& dir,
+ SGVec3d& nearestHit)
+{
+ // We assume that starting positions in the center of the earth are invalid
+ if ( norm1(pos) < 1 )
+ return false;
+
+ // Make really sure the direction is normalized, is really cheap compared to
+ // computation of ground intersection.
+ SGVec3d start = pos;
+ SGVec3d end = start + 1e5*normalize(dir); // FIXME visibility ???
- 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());
+ 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 hit;
+ return hits;
}