//
// 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 "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);
- cur_elev = -9999;
}
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::bind() {
- fgTie("/environment/ground-elevation-m", this,
- &FGScenery::get_cur_elev, &FGScenery::set_cur_elev);
}
void FGScenery::unbind() {
- fgUntie("/environment/ground-elevation-m");
+}
+
+bool
+FGScenery::get_elevation_m(double lat, double lon, double max_alt,
+ 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);
+}
+
+bool
+FGScenery::get_cart_elevation_m(const SGVec3d& pos, double max_altoff,
+ double& alt, const SGMaterial** material)
+{
+ 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);
+ }
+ }
+ }
+ }
+
+ 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 ???
+
+ 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;
+ }
+ }
+ }
+
+ return hits;
}