Mathias Fröhlich:

[flightgear.git] / src / Scenery / scenery.cxx

diff --git a/src/Scenery/scenery.cxx b/src/Scenery/scenery.cxx
index 958e27f327d42c24cf0e64d69fee9cf8370bf498..88badf93eea9498ce85dc92804f8071ef04a3526 100644 (file)
--- a/src/Scenery/scenery.cxx
+++ b/src/Scenery/scenery.cxx
@@ -2,7 +2,7 @@
 //
 // Written by Curtis Olson, started May 1997.
 //
-// Copyright (C) 1997  Curtis L. Olson  - curt@infoplane.com
+// Copyright (C) 1997  Curtis L. Olson  - http://www.flightgear.org/~curt
 //
 // This program is free software; you can redistribute it and/or
 // modify it under the terms of the GNU General Public License as
@@ -30,9 +30,12 @@
 
 #include <simgear/debug/logstream.hxx>
 #include <simgear/scene/tgdb/userdata.hxx>
+#include <simgear/math/sg_geodesy.hxx>
+#include <simgear/scene/model/placementtrans.hxx>
 
 #include <Main/fg_props.hxx>
 
+#include "hitlist.hxx"
 #include "scenery.hxx"
 
 
@@ -41,7 +44,6 @@ FGScenery::FGScenery() {
     SG_LOG( SG_TERRAIN, SG_INFO, "Initializing scenery subsystem" );
 
     center = Point3D(0.0);
-    cur_elev = -9999;
 }
 
 
@@ -72,6 +74,9 @@ void FGScenery::init() {
     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" );
 
@@ -89,11 +94,95 @@ void FGScenery::update(double dt) {
 
 
 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");
+}
+
+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)
+{
+//   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);
+}
+
+bool
+FGScenery::get_cart_elevation_m(const sgdVec3 pos, double max_altoff,
+                                double& alt, bool exact)
+{
+  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;
+    }
+  }
+
+  // overridden with actual values if a terrain intersection is
+  // found
+  double hit_radius = 0.0;
+  sgdVec3 hit_normal = { 0.0, 0.0, 0.0 };
+  
+  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);
+  }
+
+  if (replaced_center)
+    set_center( saved_center );
+  
+  return hit;
 }