fly/flightgear
1
0
Fork 0
Code Activity

Introduce a radar/in-range boolean property, end check this to see whether the CPU intensive radar calculations need to be done. If not, skip them.

Browse source
This commit is contained in:
ehofman 2004-06-10 19:14:19 +00:00
parent 6c8f7fab01
commit 4fe886f008
3 changed files with 61 additions and 41 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

98
src/AIModel/AIAircraft.cxx
View file

@ -237,77 +237,93 @@ void FGAIAircraft::Run(double dt) {
//###########################// //###########################//
// do calculations for radar // // do calculations for radar //
//###########################// //###########################//
double radar_range_ft2 = fgGetDouble("/instrumentation/radar/range");
radar_range_ft2 *= SG_NM_TO_METER * SG_METER_TO_FEET;
radar_range_ft2 *= radar_range_ft2;
// copy values from the AIManager
double user_latitude = manager->get_user_latitude(); double user_latitude = manager->get_user_latitude();
double user_longitude = manager->get_user_longitude(); double user_longitude = manager->get_user_longitude();
double user_altitude = manager->get_user_altitude();
double user_heading = manager->get_user_heading();
double user_pitch = manager->get_user_pitch();
double user_yaw = manager->get_user_yaw();
double user_speed = manager->get_user_speed();
// calculate range to target in feet and nautical miles
double lat_range = fabs(pos.lat() - user_latitude) * ft_per_deg_lat; 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 lon_range = fabs(pos.lon() - user_longitude) * ft_per_deg_lon;
double range_ft = sqrt( lat_range*lat_range + lon_range*lon_range ); double range_ft2 = lat_range*lat_range + lon_range*lon_range;
range = range_ft / 6076.11549;
// calculate bearing to target //
if (pos.lat() >= user_latitude) { // Test whether the target is within radar range.
bearing = atan2(lat_range, lon_range) * SG_RADIANS_TO_DEGREES; //
in_range = (range_ft2 <= radar_range_ft2);
if ( in_range )
{
props->setBoolValue("radar/in-range", true);
// copy values from the AIManager
double user_altitude = manager->get_user_altitude();
double user_heading = manager->get_user_heading();
double user_pitch = manager->get_user_pitch();
double user_yaw = manager->get_user_yaw();
double user_speed = manager->get_user_speed();
// calculate range to target in feet and nautical miles
double range_ft = sqrt( range_ft2 );
range = range_ft / 6076.11549;
// calculate bearing to target
if (pos.lat() >= user_latitude) {
bearing = atan2(lat_range, lon_range) * SG_RADIANS_TO_DEGREES;
if (pos.lon() >= user_longitude) { if (pos.lon() >= user_longitude) {
bearing = 90.0 - bearing; bearing = 90.0 - bearing;
} else { } else {
bearing = 270.0 + bearing; bearing = 270.0 + bearing;
} }
} else { } else {
bearing = atan2(lon_range, lat_range) * SG_RADIANS_TO_DEGREES; bearing = atan2(lon_range, lat_range) * SG_RADIANS_TO_DEGREES;
if (pos.lon() >= user_longitude) { if (pos.lon() >= user_longitude) {
bearing = 180.0 - bearing; bearing = 180.0 - bearing;
} else { } else {
bearing = 180.0 + bearing; bearing = 180.0 + bearing;
} }
} }
// calculate look left/right to target, without yaw correction // calculate look left/right to target, without yaw correction
horiz_offset = bearing - user_heading; horiz_offset = bearing - user_heading;
if (horiz_offset > 180.0) horiz_offset -= 360.0; if (horiz_offset > 180.0) horiz_offset -= 360.0;
if (horiz_offset < -180.0) horiz_offset += 360.0; if (horiz_offset < -180.0) horiz_offset += 360.0;
// calculate elevation to target // calculate elevation to target
elevation = atan2( altitude_ft - user_altitude, range_ft ) elevation = atan2( altitude_ft - user_altitude, range_ft )
* SG_RADIANS_TO_DEGREES; * SG_RADIANS_TO_DEGREES;
// calculate look up/down to target // calculate look up/down to target
vert_offset = elevation + user_pitch; vert_offset = elevation + user_pitch;
/* this calculation needs to be fixed, but it isn't important anyway /* this calculation needs to be fixed, but it isn't important anyway
// calculate range rate // calculate range rate
double recip_bearing = bearing + 180.0; double recip_bearing = bearing + 180.0;
if (recip_bearing > 360.0) recip_bearing -= 360.0; if (recip_bearing > 360.0) recip_bearing -= 360.0;
double my_horiz_offset = recip_bearing - hdg; double my_horiz_offset = recip_bearing - hdg;
if (my_horiz_offset > 180.0) my_horiz_offset -= 360.0; if (my_horiz_offset > 180.0) my_horiz_offset -= 360.0;
if (my_horiz_offset < -180.0) my_horiz_offset += 360.0; if (my_horiz_offset < -180.0) my_horiz_offset += 360.0;
rdot = (-user_speed * cos( horiz_offset * SG_DEGREES_TO_RADIANS )) rdot = (-user_speed * cos( horiz_offset * SG_DEGREES_TO_RADIANS ))
+ (-speed * 1.686 * cos( my_horiz_offset * SG_DEGREES_TO_RADIANS )); +(-speed * 1.686 * cos( my_horiz_offset * SG_DEGREES_TO_RADIANS ));
*/ */
// now correct look left/right for yaw // now correct look left/right for yaw
horiz_offset += user_yaw; horiz_offset += user_yaw;
// calculate values for radar display // calculate values for radar display
y_shift = range * cos( horiz_offset * SG_DEGREES_TO_RADIANS); y_shift = range * cos( horiz_offset * SG_DEGREES_TO_RADIANS);
x_shift = range * sin( horiz_offset * SG_DEGREES_TO_RADIANS); x_shift = range * sin( horiz_offset * SG_DEGREES_TO_RADIANS);
rotation = hdg - user_heading; rotation = hdg - user_heading;
if (rotation < 0.0) rotation += 360.0; if (rotation < 0.0) rotation += 360.0;
} else
props->setBoolValue("radar/in-range", false);
//************************************// //************************************//
// Tanker code // // Tanker code //
//************************************// //************************************//
if ( isTanker) { if ( isTanker) {
if ( (range_ft < 250.0) && if ( (range_ft2 < 250.0 * 250.0) &&
(y_shift > 0.0) && (y_shift > 0.0) &&
(elevation > 0.0) ) { (elevation > 0.0) ) {
refuel_node->setBoolValue(true); refuel_node->setBoolValue(true);

3
src/AIModel/AIBase.cxx
View file

@ -48,6 +48,7 @@ FGAIBase::FGAIBase() {
tgt_roll = roll = tgt_pitch = tgt_yaw = tgt_vs = vs = pitch = 0.0; tgt_roll = roll = tgt_pitch = tgt_yaw = tgt_vs = vs = pitch = 0.0;
bearing = elevation = range = rdot = 0.0; bearing = elevation = range = rdot = 0.0;
x_shift = y_shift = rotation = 0.0; x_shift = y_shift = rotation = 0.0;
in_range = false;
invisible = true; invisible = true;
no_roll = true; no_roll = true;
model_path = ""; model_path = "";
@ -139,6 +140,7 @@ void FGAIBase::bind() {
props->tie("orientation/roll-deg", SGRawValuePointer<double>(&roll)); props->tie("orientation/roll-deg", SGRawValuePointer<double>(&roll));
props->tie("orientation/true-heading-deg", SGRawValuePointer<double>(&hdg)); props->tie("orientation/true-heading-deg", SGRawValuePointer<double>(&hdg));
props->tie("radar/in-range", SGRawValuePointer<bool>(&in_range));
props->tie("radar/bearing-deg", SGRawValuePointer<double>(&bearing)); props->tie("radar/bearing-deg", SGRawValuePointer<double>(&bearing));
props->tie("radar/elevation-deg", SGRawValuePointer<double>(&elevation)); props->tie("radar/elevation-deg", SGRawValuePointer<double>(&elevation));
props->tie("radar/range-nm", SGRawValuePointer<double>(&range)); props->tie("radar/range-nm", SGRawValuePointer<double>(&range));
@ -167,6 +169,7 @@ void FGAIBase::unbind() {
props->untie("orientation/roll-deg"); props->untie("orientation/roll-deg");
props->untie("orientation/true-heading-deg"); props->untie("orientation/true-heading-deg");
props->untie("radar/in-range");
props->untie("radar/bearing-deg"); props->untie("radar/bearing-deg");
props->untie("radar/elevation-deg"); props->untie("radar/elevation-deg");
props->untie("radar/range-nm"); props->untie("radar/range-nm");

1
src/AIModel/AIBase.hxx
View file

@ -86,6 +86,7 @@ protected:
double tgt_vs; double tgt_vs;
// these describe radar information for the user // these describe radar information for the user
bool in_range; // true if in range of the radar, otherwise false
double bearing; // true bearing from user to this model double bearing; // true bearing from user to this model
double elevation; // elevation in degrees from user to this model double elevation; // elevation in degrees from user to this model
double range; // range from user to this model, nm double range; // range from user to this model, nm