#include <simgear/debug/logstream.hxx>
#include <stdlib.h>
+#include <algorithm>
+
+#include <simgear/structure/exception.hxx>
+
#include <Main/fg_props.hxx>
+#include "environment_mgr.hxx"
#include "environment_ctrl.hxx"
+SG_USING_STD(sort);
+
+// FIXME, from options.cxx
+extern void fgSetupWind (double min_hdg, double max_hdg, double speed, double gust);
+
\f
////////////////////////////////////////////////////////////////////////
}
void
-FGUserDefEnvironmentCtrl::update (int dt)
+FGUserDefEnvironmentCtrl::update (double dt)
{
double base_wind_speed = _base_wind_speed_node->getDoubleValue();
double gust_wind_speed = _gust_wind_speed_node->getDoubleValue();
+ if (gust_wind_speed < base_wind_speed) {
+ gust_wind_speed = base_wind_speed;
+ _gust_wind_speed_node->setDoubleValue(gust_wind_speed);
+ }
+
if (base_wind_speed == gust_wind_speed) {
_current_wind_speed_kt = base_wind_speed;
} else {
_environment->set_wind_speed_kt(_current_wind_speed_kt);
}
+
+\f
+////////////////////////////////////////////////////////////////////////
+// Implementation of FGInterpolateEnvironmentCtrl.
+////////////////////////////////////////////////////////////////////////
+
+FGInterpolateEnvironmentCtrl::FGInterpolateEnvironmentCtrl ()
+{
+}
+
+FGInterpolateEnvironmentCtrl::~FGInterpolateEnvironmentCtrl ()
+{
+ unsigned int i;
+ for (i = 0; i < _boundary_table.size(); i++)
+ delete _boundary_table[i];
+ for (i = 0; i < _aloft_table.size(); i++)
+ delete _aloft_table[i];
+}
+
+
+
+void
+FGInterpolateEnvironmentCtrl::init ()
+{
+ read_table(fgGetNode("/environment/config/boundary", true),
+ _boundary_table);
+ read_table(fgGetNode("/environment/config/aloft", true),
+ _aloft_table);
+}
+
+void
+FGInterpolateEnvironmentCtrl::reinit ()
+{
+ unsigned int i;
+ for (i = 0; i < _boundary_table.size(); i++)
+ delete _boundary_table[i];
+ for (i = 0; i < _aloft_table.size(); i++)
+ delete _aloft_table[i];
+ _boundary_table.clear();
+ _aloft_table.clear();
+ init();
+}
+
+void
+FGInterpolateEnvironmentCtrl::read_table (const SGPropertyNode * node,
+ vector<bucket *> &table)
+{
+ for (int i = 0; i < node->nChildren(); i++) {
+ const SGPropertyNode * child = node->getChild(i);
+ if ( strcmp(child->getName(), "entry") == 0
+ && child->getStringValue("elevation-ft", "")[0] != '\0'
+ && ( child->getDoubleValue("elevation-ft") > 0.1 || i == 0 ) )
+ {
+ bucket * b = new bucket;
+ if (i > 0)
+ b->environment.copy(table[i-1]->environment);
+ b->environment.read(child);
+ b->altitude_ft = b->environment.get_elevation_ft();
+ table.push_back(b);
+ }
+ }
+ sort(table.begin(), table.end());
+}
+
+void
+FGInterpolateEnvironmentCtrl::update (double delta_time_sec)
+{
+ // FIXME
+ double altitude_ft = fgGetDouble("/position/altitude-ft");
+ double altitude_agl_ft = fgGetDouble("/position/altitude-agl-ft");
+ double boundary_transition =
+ fgGetDouble("/environment/config/boundary-transition-ft", 500);
+
+ // double ground_elevation_ft = altitude_ft - altitude_agl_ft;
+
+ int length = _boundary_table.size();
+
+ if (length > 0) {
+ // boundary table
+ double boundary_limit = _boundary_table[length-1]->altitude_ft;
+ if (boundary_limit >= altitude_agl_ft) {
+ do_interpolate(_boundary_table, altitude_agl_ft,
+ _environment);
+ return;
+ } else if ((boundary_limit + boundary_transition) >= altitude_agl_ft) {
+ // both tables
+ do_interpolate(_boundary_table, altitude_agl_ft, &env1);
+ do_interpolate(_aloft_table, altitude_ft, &env2);
+ double fraction =
+ (altitude_agl_ft - boundary_limit) / boundary_transition;
+ interpolate(&env1, &env2, fraction, _environment);
+ return;
+ }
+ }
+
+ // aloft table
+ do_interpolate(_aloft_table, altitude_ft, _environment);
+}
+
+void
+FGInterpolateEnvironmentCtrl::do_interpolate (vector<bucket *> &table,
+ double altitude_ft,
+ FGEnvironment * environment)
+{
+ int length = table.size();
+ if (length == 0)
+ return;
+
+ // Boundary conditions
+ if ((length == 1) || (table[0]->altitude_ft >= altitude_ft)) {
+ environment->copy(table[0]->environment);
+ return;
+ } else if (table[length-1]->altitude_ft <= altitude_ft) {
+ environment->copy(table[length-1]->environment);
+ return;
+ }
+
+ // Search the interpolation table
+ for (int i = 0; i < length - 1; i++) {
+ if ((i == length - 1) || (table[i]->altitude_ft <= altitude_ft)) {
+ FGEnvironment * env1 = &(table[i]->environment);
+ FGEnvironment * env2 = &(table[i+1]->environment);
+ double fraction;
+ if (table[i]->altitude_ft == table[i+1]->altitude_ft)
+ fraction = 1.0;
+ else
+ fraction =
+ ((altitude_ft - table[i]->altitude_ft) /
+ (table[i+1]->altitude_ft - table[i]->altitude_ft));
+ interpolate(env1, env2, fraction, environment);
+
+ return;
+ }
+ }
+}
+
+bool
+FGInterpolateEnvironmentCtrl::bucket::operator< (const bucket &b) const
+{
+ return (altitude_ft < b.altitude_ft);
+}
+
+
+\f
+////////////////////////////////////////////////////////////////////////
+// Implementation of FGMetarEnvironmentCtrl.
+////////////////////////////////////////////////////////////////////////
+
+FGMetarEnvironmentCtrl::FGMetarEnvironmentCtrl ()
+ : env( new FGInterpolateEnvironmentCtrl ),
+ _icao( strdup( fgGetString("/sim/presets/airport-id") ) )
+{
+}
+
+FGMetarEnvironmentCtrl::~FGMetarEnvironmentCtrl ()
+{
+ if (_icao) {
+ free(_icao);
+ _icao = NULL;
+ }
+
+ delete env;
+ env = NULL;
+}
+
+
+void
+FGMetarEnvironmentCtrl::init ()
+{
+ if (_icao != NULL) {
+ free(_icao);
+ _icao = NULL;
+ }
+
+ fetch_data(_icao);
+ fgSetupWind( fgGetDouble("/environment/metar/base-wind-range-from"),
+ fgGetDouble("/environment/metar/base-wind-range-to"),
+ fgGetDouble("/environment/metar/base-wind-speed-kt"),
+ fgGetDouble("/environment/metar/gust-wind-speed-kt") );
+
+ fgSetDouble("/environment/visibility-m",
+ fgGetDouble("/environment/metar/min-visibility-m"));
+ fgSetDouble("/environment/temperature-degc",
+ fgGetDouble("/environment/metar/temperature-degc"));
+ fgSetDouble("/environment/dewpoint-degc",
+ fgGetDouble("/environment/metar/dewpoint-degc"));
+ fgSetDouble("/environment/pressure-inhg",
+ fgGetDouble("/environment/metar/pressure-inhg"));
+
+ env->init();
+}
+
+void
+FGMetarEnvironmentCtrl::reinit ()
+{
+#if 0
+ if (_icao != NULL) {
+ free(_icao);
+ _icao = NULL;
+ }
+
+ fetch_data(_icao);
+ fgSetupWind( fgGetDouble("/environment/metar/base-wind-range-from"),
+ fgGetDouble("/environment/metar/base-wind-range-to"),
+ fgGetDouble("/environment/metar/base-wind-speed-kt"),
+ fgGetDouble("/environment/metar/gust-wind-speed-kt") );
+
+ fgSetDouble("/environment/visibility-m",
+ fgGetDouble("/environment/metar/min-visibility-m"));
+ fgSetDouble("/environment/pressure-inhg",
+ fgGetDouble("/environment/metar/pressure-inhg"));
+
+ // FIXME: The following seem to egt overriden?
+ fgSetDouble("/environment/temperature-degc",
+ fgGetDouble("/environment/metar/temperature-degc"));
+ fgSetDouble("/environment/dewpoint-degc",
+ fgGetDouble("/environment/metar/dewpoint-degc"));
+#endif
+
+ env->reinit();
+}
+
+void
+FGMetarEnvironmentCtrl::update(double delta_time_sec)
+{
+ env->update(delta_time_sec);
+}
+
+void
+FGMetarEnvironmentCtrl::setEnvironment (FGEnvironment * environment)
+{
+ env->setEnvironment(environment);
+}
+
+void
+FGMetarEnvironmentCtrl::fetch_data (const char *icao)
+{
+ char s[128];
+ double d, dt;
+ int i;
+
+ if ((icao == NULL) && (_icao == NULL)) {
+ _icao = strdup( fgGetString("/sim/presets/airport-id") );
+
+ } else if (icao != NULL) {
+ if (_icao != NULL)
+ free(_icao);
+
+ _icao = strdup(icao);
+ }
+
+ SGMetar *m;
+ try {
+ m = new SGMetar(_icao);
+ } catch (const sg_io_exception& e) {
+ SG_LOG( SG_GENERAL, SG_WARN, "Error fetching live weather data: "
+ << e.getFormattedMessage().c_str() );
+ return;
+ }
+
+ d = m->getMinVisibility().getVisibility_m();
+ d = (d != SGMetarNaN) ? d : 10000;
+ fgSetDouble("/environment/metar/min-visibility-m", d);
+
+ dt = m->getMaxVisibility().getVisibility_m();
+ d = (dt != SGMetarNaN) ? dt : d;
+ fgSetDouble("/environment/metar/max-visibility-m", d);
+
+ SGMetarVisibility *dirvis = m->getDirVisibility();
+ for (i = 0; i < 8; i++, dirvis++) {
+ const char *min = "/environment/metar/visibility[%d]/min-m";
+ const char *max = "/environment/metar/visibility[%d]/max-m";
+ char s[128];
+
+ d = dirvis->getVisibility_m();
+ d = (d != SGMetarNaN) ? d : 10000;
+
+ snprintf(s, 128, min, i);
+ fgSetDouble(s, d);
+ snprintf(s, 128, max, i);
+ fgSetDouble(s, d);
+ }
+
+ i = m->getWindDir();
+ if ( i == -1 ) {
+ fgSetInt("/environment/metar/base-wind-range-from",
+ m->getWindRangeFrom() );
+ fgSetInt("/environment/metar/base-wind-range-to",
+ m->getWindRangeTo() );
+ } else {
+ fgSetInt("/environment/metar/base-wind-range-from", i);
+ fgSetInt("/environment/metar/base-wind-range-to", i);
+ }
+ fgSetDouble("/environment/metar/base-wind-speed-kt",
+ m->getWindSpeed_kt() );
+
+ d = m->getGustSpeed_kt();
+ d = (d != SGMetarNaN) ? d : 0.0;
+ fgSetDouble("/environment/metar/gust-wind-speed-kt", d);
+
+ d = m->getTemperature_C();
+ if (d != SGMetarNaN) {
+ dt = m->getDewpoint_C();
+ dt = (dt != SGMetarNaN) ? dt : 0.0;
+ fgSetDouble("/environment/metar/dewpoint-degc", dt);
+ fgSetDouble("/environment/metar/rel-humidity-norm",
+ m->getRelHumidity() );
+ }
+ d = (d != SGMetarNaN) ? d : 15.0;
+ fgSetDouble("/environment/metar/temperature-degc", d);
+
+ d = m->getPressure_inHg();
+ d = (d != SGMetarNaN) ? d : 30.0;
+ fgSetDouble("/environment/metar/pressure-inhg", d);
+
+ vector<SGMetarCloud> cv = m->getClouds();
+ vector<SGMetarCloud>::iterator cloud;
+
+ const char *cl = "/environment/clouds/layer[%i]";
+ for (i = 0, cloud = cv.begin(); cloud != cv.end(); cloud++, i++) {
+ const char *coverage_string[5] =
+ { "clear", "few", "scattered", "broken", "overcast" };
+ const double thickness[5] = { 0, 65, 600,750, 1000};
+ int q;
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/coverage", 128);
+ q = cloud->getCoverage();
+ q = (q != -1 ) ? q : 0;
+ fgSetString(s, coverage_string[q] );
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/elevation-ft", 128);
+ d = cloud->getAltitude_ft();
+ d = (d != SGMetarNaN) ? d : -9999;
+ fgSetDouble(s, d);
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/thickness-ft", 128);
+ fgSetDouble(s, thickness[q]);
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/span-m", 128);
+ fgSetDouble(s, 40000.0);
+ }
+ for (; i < FGEnvironmentMgr::MAX_CLOUD_LAYERS; i++) {
+ snprintf(s, 128, cl, i);
+ strncat(s, "/coverage", 128);
+ fgSetString(s, "clear");
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/elevation-ft", 128);
+ fgSetDouble(s, -9999);
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/thickness-ft", 128);
+ fgSetDouble(s, 0);
+
+ snprintf(s, 128, cl, i);
+ strncat(s, "/span-m", 128);
+ fgSetDouble(s, 40000.0);
+ }
+
+ delete m;
+}
+
+
// end of environment_ctrl.cxx
projects / flightgear.git / blobdiff