113 lines
3 KiB
C++
113 lines
3 KiB
C++
|
// FGAIThermal - FGAIBase-derived class creates an AI thermal
|
||
|
|
//
|
||
|
|
// Written by David Culp, started Feb 2004.
|
||
|
|
//
|
||
|
|
// Copyright (C) 2004 David P. Culp - davidculp2@comcast.net
|
||
|
|
//
|
||
|
|
// This program is free software; you can redistribute it and/or
|
||
|
|
// modify it under the terms of the GNU General Public License as
|
||
|
|
// published by the Free Software Foundation; either version 2 of the
|
||
|
|
// License, or (at your option) any later version.
|
||
|
|
//
|
||
|
|
// This program is distributed in the hope that it will be useful, but
|
||
|
|
// WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
|
// General Public License for more details.
|
||
|
|
//
|
||
|
|
// 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.
|
||
|
|
|
||
|
|
#ifdef HAVE_CONFIG_H
|
||
|
|
# include <config.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#include <simgear/math/point3d.hxx>
|
||
|
|
#include <Main/fg_props.hxx>
|
||
|
|
#include <Main/globals.hxx>
|
||
|
|
#include <Scenery/scenery.hxx>
|
||
|
|
#include <string>
|
||
|
|
#include <math.h>
|
||
|
|
|
||
|
|
SG_USING_STD(string);
|
||
|
|
|
||
|
|
#include "AIThermal.hxx"
|
||
|
|
|
||
|
|
|
||
|
|
FGAIThermal *FGAIThermal::_self = NULL;
|
||
|
|
|
||
|
|
FGAIThermal::FGAIThermal(FGAIManager* mgr) {
|
||
|
|
manager = mgr;
|
||
|
|
_self = this;
|
||
|
|
_type_str = "thermal";
|
||
|
|
strength = 6.0;
|
||
|
|
diameter = 0.5;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
FGAIThermal::~FGAIThermal() {
|
||
|
|
_self = NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
bool FGAIThermal::init() {
|
||
|
|
wind_from_down = fgGetNode("/environment/wind-from-down-fps", true);
|
||
|
|
scaler = 8.0 * strength / (diameter * diameter * diameter);
|
||
|
|
return FGAIBase::init();
|
||
|
|
}
|
||
|
|
|
||
|
|
void FGAIThermal::bind() {
|
||
|
|
FGAIBase::bind();
|
||
|
|
}
|
||
|
|
|
||
|
|
void FGAIThermal::unbind() {
|
||
|
|
FGAIBase::unbind();
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void FGAIThermal::update(double dt) {
|
||
|
|
Run(dt);
|
||
|
|
Transform();
|
||
|
|
FGAIBase::update(dt);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void FGAIThermal::Run(double dt) {
|
||
|
|
|
||
|
|
FGAIThermal::dt = dt;
|
||
|
|
|
||
|
|
double ft_per_deg_lon;
|
||
|
|
double ft_per_deg_lat;
|
||
|
|
|
||
|
|
// get size of a degree at this latitude
|
||
|
|
ft_per_deg_lat = 366468.96 - 3717.12 * cos(pos.lat()/SG_RADIANS_TO_DEGREES);
|
||
|
|
ft_per_deg_lon = 365228.16 * cos(pos.lat() / SG_RADIANS_TO_DEGREES);
|
||
|
|
|
||
|
|
double altitude_ft = altitude * SG_METER_TO_FEET;
|
||
|
|
|
||
|
|
//###########################//
|
||
|
|
// do calculations for range //
|
||
|
|
//###########################//
|
||
|
|
|
||
|
|
// copy values from the AIManager
|
||
|
|
double user_latitude = manager->get_user_latitude();
|
||
|
|
double user_longitude = manager->get_user_longitude();
|
||
|
|
double user_altitude = manager->get_user_altitude();
|
||
|
|
|
||
|
|
// calculate range to target in feet and nautical miles
|
||
|
|
double lat_range = fabs(pos.lat() - user_latitude) * ft_per_deg_lat;
|
||
|
|
double lon_range = fabs(pos.lon() - user_longitude) * ft_per_deg_lon;
|
||
|
|
double range_ft = sqrt( lat_range*lat_range + lon_range*lon_range );
|
||
|
|
range = range_ft / 6076.11549;
|
||
|
|
|
||
|
|
// Set rising air if within range.
|
||
|
|
// Air vertical speed is maximum at center of thermal,
|
||
|
|
// and decreases to zero at the edge (as distance cubed).
|
||
|
|
if (range < (diameter * 0.5)) {
|
||
|
|
wind_from_down->setDoubleValue( strength - (range * range * range * scaler) );
|
||
|
|
} else {
|
||
|
|
wind_from_down->setDoubleValue( 0.0 );
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|