#ifdef _MSC_VER
# include <float.h>
# define finite _finite
-#elif defined(sun) || defined(sgi)
+#elif defined(__sun) || defined(sgi)
# include <ieeefp.h>
#endif
Transform(); // make sure aip is initialized.
getGroundElev(dt); // make sure it's exectuted first time around, so force a large dt value
//getGroundElev(dt); // Need to do this twice.
- //cerr << trafficRef->getRegistration() << " Setting altitude to " << tgt_altitude << endl;
- setAltitude(tgt_altitude);
+ //cerr << trafficRef->getRegistration() << " Setting altitude to " << tgt_altitude;
+ doGroundAltitude();
+ //cerr << " Actual altitude " << altitude << endl;
+ // Transform();
+ pos.setelev(altitude * SG_FEET_TO_METER);
}
return;
}
if (no_roll)
{
getGroundElev(dt);
+ doGroundAltitude();
}
- // find target vertical speed if altitude lock engaged
- if (alt_lock && use_perf_vs) {
- if (altitude_ft < tgt_altitude) {
- tgt_vs = tgt_altitude - altitude_ft;
- if (tgt_vs > performance->climb_rate)
- tgt_vs = performance->climb_rate;
- } else {
- tgt_vs = tgt_altitude - altitude_ft;
- if (tgt_vs < (-performance->descent_rate))
- tgt_vs = -performance->descent_rate;
+ else
+ {
+ // find target vertical speed if altitude lock engaged
+ if (alt_lock && use_perf_vs) {
+ if (altitude_ft < tgt_altitude) {
+ tgt_vs = tgt_altitude - altitude_ft;
+ if (tgt_vs > performance->climb_rate)
+ tgt_vs = performance->climb_rate;
+ } else {
+ tgt_vs = tgt_altitude - altitude_ft;
+ if (tgt_vs < (-performance->descent_rate))
+ tgt_vs = -performance->descent_rate;
+ }
+ }
+
+ if (alt_lock && !use_perf_vs) {
+ double max_vs = 4*(tgt_altitude - altitude);
+ double min_vs = 100;
+ if (tgt_altitude < altitude) min_vs = -100.0;
+ if ((fabs(tgt_altitude - altitude) < 1500.0) &&
+ (fabs(max_vs) < fabs(tgt_vs))) tgt_vs = max_vs;
+ if (fabs(tgt_vs) < fabs(min_vs)) tgt_vs = min_vs;
+ }
}
- }
-
- if (alt_lock && !use_perf_vs) {
- double max_vs = 4*(tgt_altitude - altitude);
- double min_vs = 100;
- if (tgt_altitude < altitude) min_vs = -100.0;
- if ((fabs(tgt_altitude - altitude) < 1500.0) &&
- (fabs(max_vs) < fabs(tgt_vs))) tgt_vs = max_vs;
- if (fabs(tgt_vs) < fabs(min_vs)) tgt_vs = min_vs;
- }
-
// adjust vertical speed
double vs_diff = tgt_vs - vs;
if (fabs(vs_diff) > 10.0) {
use_perf_vs = false;
tgt_vs = (curr->crossat - prev->altitude)/
(fp->getDistanceToGo(pos.lat(), pos.lon(), curr)/
- 6076.0/prev->speed*60.0);
- tgt_altitude = curr->crossat;
+ 6076.0/prev->speed*60.0);
+ tgt_altitude = curr->crossat;
} else {
use_perf_vs = true;
tgt_altitude = prev->altitude;
getGroundElev(60.1); // make sure it's exectuted first time around, so force a large dt value
//getGroundElev(60.1); // Need to do this twice.
//cerr << trafficRef->getRegistration() << " Setting altitude to " << tgt_altitude << endl;
- setAltitude(tgt_altitude);
+ doGroundAltitude(); //(tgt_altitude);
}
prevSpeed = 0;
//cout << "First waypoint: " << prev->name << endl;
// << arr->getId() <<endl;
// }
if (prev->name == "park2")
- dep->releaseParking(fp->getGate());
-
+ {
+ dep->getDynamics()->releaseParking(fp->getGate());
+ }
+ // Some debug messages, specific to TESTING THE Logical networks.
//if ((arr->getId() == string("EHAM")) && (prev->name == "Center"))
// {
//
fp->setLeadDistance(speed, tgt_heading, curr, next);
}
//cerr << "5.1" << endl;
- if (curr->crossat > -1000.0) {
- //cerr << "5.1a" << endl;
- use_perf_vs = false;
- tgt_vs = (curr->crossat - altitude)/
- (fp->getDistanceToGo(pos.lat(), pos.lon(), curr)/6076.0/speed*60.0);
- //cerr << "5.1b" << endl;
- tgt_altitude = curr->crossat;
- } else {
- //cerr << "5.1c" << endl;
- use_perf_vs = true;
- //cerr << "5.1d" << endl;
+ if (!(prev->on_ground)) { // only update the tgt altitude from flightplan if not on the ground
tgt_altitude = prev->altitude;
- //cerr << "Setting target altitude : " <<tgt_altitude << endl;
+ if (curr->crossat > -1000.0) {
+ //cerr << "5.1a" << endl;
+ use_perf_vs = false;
+ tgt_vs = (curr->crossat - altitude)/
+ (fp->getDistanceToGo(pos.lat(), pos.lon(), curr)/6076.0/speed*60.0);
+ //cerr << "5.1b" << endl;
+ tgt_altitude = curr->crossat;
+ } else {
+ //cerr << "5.1c" << endl;
+ use_perf_vs = true;
+ //cerr << "5.1d" << endl;
+
+ //cerr << "Setting target altitude : " <<tgt_altitude << endl;
+ }
}
//cerr << "6" << endl;
tgt_speed = prev->speed;
void FGAIAircraft::getGroundElev(double dt) {
dt_elev_count += dt;
//return;
- if (dt_elev_count < (10.0 + (rand() % 100))) // Update minimally every 10 secs, but add some randomness to prevent them all IA objects doing this synced
- {
- return;
- }
- else
- {
- dt_elev_count = 0;
- }
+ if (dt_elev_count < (3.0) + (rand() % 10)) //Update minimally every three secs, but add some randomness to prevent all IA objects doing this in synchrony
+ {
+ return;
+ }
+ else
+ {
+ dt_elev_count = 0;
+ }
// It would be nice if we could set the correct tile center here in order to get a correct
// answer with one call to the function, but what I tried in the two commented-out lines
// below only intermittently worked, and I haven't quite groked why yet.
return;
}
-
- //globals->get_tile_mgr()->prep_ssg_nodes( acmodel_location,
- globals->get_tile_mgr()->prep_ssg_nodes( aip.getSGLocation(), visibility_meters );
- Point3D scenery_center = globals->get_scenery()->get_center();
-
- globals->get_tile_mgr()->update( aip.getSGLocation(),
- visibility_meters,
- (aip.getSGLocation())->get_absolute_view_pos( scenery_center ) );
- // save results of update in SGLocation for fdm...
-
- //if ( globals->get_scenery()->get_cur_elev() > -9990 ) {
- // acmodel_location->
- // set_cur_elev_m( globals->get_scenery()->get_cur_elev() );
- //}
-
- // The need for this here means that at least 2 consecutive passes are needed :-(
- aip.getSGLocation()->set_tile_center( globals->get_scenery()->get_next_center() );
- globals->get_tile_mgr()->prep_ssg_nodes( aip.getSGLocation(), visibility_meters );
- //Point3D scenery_center = globals->get_scenery()->get_center();
-
- globals->get_tile_mgr()->update( aip.getSGLocation(),
- visibility_meters,
- (aip.getSGLocation())->get_absolute_view_pos( scenery_center ) );
- // save results of update in SGLocation for fdm...
-
- //if ( globals->get_scenery()->get_cur_elev() > -9990 ) {
- // acmodel_location->
- // set_cur_elev_m( globals->get_scenery()->get_cur_elev() );
- //}
-
- // The need for this here means that at least 2 consecutive passes are needed :-(
- aip.getSGLocation()->set_tile_center( globals->get_scenery()->get_next_center() );
- //cerr << "Transform Elev is " << globals->get_scenery()->get_cur_elev() << '\n';
- tgt_altitude = (globals->get_scenery()->get_cur_elev() * SG_METER_TO_FEET) + groundOffset;
-}
-
-//globals->get_tile_mgr()->prep_ssg_nodes( _aip.getSGLocation(), visibility_meters );
-//Point3D scenery_center = globals->get_scenery()->get_center();
-//globals->get_tile_mgr()->update(_aip.getSGLocation(), visibility_meters, (_aip.getSGLocation())->get_absolute_view_pos( scenery_center ) );
-// save results of update in SGLocation for fdm...
-
-//if ( globals->get_scenery()->get_cur_elev() > -9990 ) {
-// acmodel_location->
-// set_cur_elev_m( globals->get_scenery()->get_cur_elev() );
-//}
+ // FIXME: make sure the pos.lat/pos.lon values are in degrees ...
+ double range = 500.0;
+ if (!globals->get_tile_mgr()->scenery_available(pos.lat(), pos.lon(), range))
+ {
+ // Try to shedule tiles for that position.
+ globals->get_tile_mgr()->update( aip.getSGLocation(), range );
+ }
-// The need for this here means that at least 2 consecutive passes are needed :-(
-//_aip.getSGLocation()->set_tile_center( globals->get_scenery()->get_next_center() );
+ // FIXME: make sure the pos.lat/pos.lon values are in degrees ...
+ double alt;
+ if (globals->get_scenery()->get_elevation_m(pos.lat(), pos.lon(),
+ 20000.0, alt))
+ tgt_altitude = alt * SG_METER_TO_FEET;
+ //cerr << "Target altitude : " << tgt_altitude << endl;
+ // if (globals->get_scenery()->get_elevation_m(pos.lat(), pos.lon(),
+ // 20000.0, alt))
+ // tgt_altitude = alt * SG_METER_TO_FEET;
+ //cerr << "Target altitude : " << tgt_altitude << endl;
+}
-//cout << "Transform Elev is " << globals->get_scenery()->get_cur_elev() << '\n';
-//_aip.getSGLocation()->set_cur_elev_m(globals->get_scenery()->get_cur_elev());
-//return(globals->get_scenery()->get_cur_elev());
-//}
+void FGAIAircraft::doGroundAltitude()
+{
+ if (fabs(altitude - (tgt_altitude+groundOffset)) > 1000.0)
+ altitude = (tgt_altitude + groundOffset);
+ else
+ altitude += 0.1 * ((tgt_altitude+groundOffset) - altitude);
+}