-// FGAIAircraft - FGAIBase-derived class creates an AI airplane
+// // // FGAIAircraft - FGAIBase-derived class creates an AI airplane
//
// Written by David Culp, started October 2003.
//
FGAIAircraft::FGAIAircraft(FGAISchedule *ref) : FGAIBase(otAircraft) {
trafficRef = ref;
- if (trafficRef)
+ if (trafficRef) {
groundOffset = trafficRef->getGroundOffset();
+ setCallSign(trafficRef->getCallSign());
+ }
else
groundOffset = 0;
holdPos = false;
_performance = 0; //TODO initialize to JET_TRANSPORT from PerformanceDB
+
}
props->tie("controls/gear/gear-down",
SGRawValueMethods<FGAIAircraft,bool>(*this,
&FGAIAircraft::_getGearDown));
- props->setStringValue("callsign", callsign.c_str());
}
}
if (next) {
- fp->setLeadDistance(speed, tgt_heading, curr, next);
+ fp->setLeadDistance(tgt_speed, tgt_heading, curr, next);
}
if (!(prev->on_ground)) // only update the tgt altitude from flightplan if not on the ground
int leg;
if ((leg = fp->getLeg()) == 10) {
trafficRef->next();
+ setCallSign(trafficRef->getCallSign());
+ //props->setStringValue("callsign", callsign.c_str());
leg = 1;
fp->setLeg(leg);
}
}
-void FGAIAircraft::setCallSign(const string& s) {
- callsign = s;
-}
-
-
void FGAIAircraft::doGroundAltitude() {
if (fabs(altitude_ft - (tgt_altitude_ft+groundOffset)) > 1000.0)
altitude_ft = (tgt_altitude_ft + groundOffset);
void FGAIAircraft::handleFirstWaypoint() {
bool eraseWaypoints; //TODO YAGNI
+ headingError = 0;
if (trafficRef) {
eraseWaypoints = true;
} else {
//cerr << "2" << endl;
double lead_dist = fp->getLeadDistance();
- //cerr << " Distance : " << dist_to_go << ": Lead distance " << lead_dist << endl;
// experimental: Use fabs, because speed can be negative (I hope) during push_back.
if (lead_dist < fabs(2*speed)) {
}
//prev_dist_to_go = dist_to_go;
+ //if (dist_to_go < lead_dist)
+ // cerr << trafficRef->getCallSign() << " Distance : " << dist_to_go << ": Lead distance " << lead_dist << " " << curr->name << endl;
return dist_to_go < lead_dist;
}
// This waypoint marks the fact that the aircraft has passed the initial taxi
// departure waypoint, so it can release the parking.
- if (prev->name == "park2") {
+ if (prev->name == "PushBackPoint") {
dep->getDynamics()->releaseParking(fp->getGate());
+ time_t holdUntil = now + 120;
+ fp->setTime(holdUntil);
+ //cerr << _getCallsign() << "Holding at pushback point" << endl;
}
// This is the last taxi waypoint, and marks the the end of the flight plan
if (finite(calc_bearing)) {
double hdg_error = calc_bearing - tgt_heading;
- if (fabs(hdg_error) > 1.0) {
+ if (fabs(hdg_error) > 0.01) {
TurnTo( calc_bearing );
}
if (fabs(speed_diff) > 10) {
prevSpeed = speed;
- fp->setLeadDistance(speed, tgt_heading, curr, next);
+ if (next) {
+ fp->setLeadDistance(speed, tgt_heading, curr, next);
+ }
}
}
time_t now = time(NULL) + fgGetLong("/sim/time/warp");
//cerr << "UpateTArgetValues() " << endl;
ProcessFlightPlan(dt, now);
- if (! fp->isActive(now)) {
- // Do execute Ground elev for inactive aircraft, so they
- // Are repositioned to the correct ground altitude when the user flies within visibility range.
- // In addition, check whether we are out of user range, so this aircraft
- // can be deleted.
- if (onGround()) {
+
+ // Do execute Ground elev for inactive aircraft, so they
+ // Are repositioned to the correct ground altitude when the user flies within visibility range.
+ // In addition, check whether we are out of user range, so this aircraft
+ // can be deleted.
+ if (onGround()) {
Transform(); // make sure aip is initialized.
- if (trafficRef) {
- //cerr << trafficRef->getRegistration() << " Setting altitude to " << altitude_ft;
- if (! aiTrafficVisible()) {
- setDie(true);
- throw AI_OutOfSight();
- }
- getGroundElev(dt);
- doGroundAltitude();
- // Transform();
- pos.setElevationFt(altitude_ft);
- }
+ getGroundElev(dt);
+ doGroundAltitude();
+ // Transform();
+ pos.setElevationFt(altitude_ft);
+ }
+ if (trafficRef) {
+ //cerr << trafficRef->getRegistration() << " Setting altitude to " << altitude_ft;
+ if (! aiTrafficVisible()) {
+ setDie(true);
+ //cerr << trafficRef->getRegistration() << " is set to die " << endl;
+ throw AI_OutOfSight();
}
+ }
+ if (! fp->isActive(now)) {
throw FP_Inactive();
}
- }
- else {
+ } else {
// no flight plan, update target heading, speed, and altitude
// from control properties. These default to the initial
// settings in the config file, but can be changed "on the
// If on ground, calculate heading change directly
if (onGround()) {
double headingDiff = fabs(hdg-tgt_heading);
+ double bank_sense = 0.0;
+ /*
+ double diff = fabs(hdg - tgt_heading);
+ if (diff > 180)
+ diff = fabs(diff - 360);
+ double sum = hdg + diff;
+ if (sum > 360.0)
+ sum -= 360.0;
+ if (fabs(sum - tgt_heading) < 1.0) {
+ bank_sense = 1.0; // right turn
+ } else {
+ bank_sense = -1.0; // left turn
+ }*/
if (headingDiff > 180)
headingDiff = fabs(headingDiff - 360);
-
- groundTargetSpeed = tgt_speed - (tgt_speed * (headingDiff/45));
+ double sum = hdg + headingDiff;
+ if (sum > 360.0)
+ sum -= 360.0;
+ if (fabs(sum - tgt_heading) > 0.0001) {
+ bank_sense = -1.0;
+ } else {
+ bank_sense = 1.0;
+ }
+ if (trafficRef)
+ //cerr << trafficRef->getCallSign() << " Heading "
+ // << hdg << ". Target " << tgt_heading << ". Diff " << fabs(sum - tgt_heading) << ". Speed " << speed << endl;
+ //if (headingDiff > 60) {
+ groundTargetSpeed = tgt_speed; // * cos(headingDiff * SG_DEGREES_TO_RADIANS);
+ //groundTargetSpeed = tgt_speed - tgt_speed * (headingDiff/180);
+ //} else {
+ // groundTargetSpeed = tgt_speed;
+ //}
if (sign(groundTargetSpeed) != sign(tgt_speed))
groundTargetSpeed = 0.21 * sign(tgt_speed); // to prevent speed getting stuck in 'negative' mode
if (headingDiff > 30.0) {
// invert if pushed backward
- headingChangeRate += dt * sign(roll);
-
- if (headingChangeRate > 30)
- headingChangeRate = 30;
- else if (headingChangeRate < -30)
- headingChangeRate = -30;
-
+ headingChangeRate += 10.0 * dt * sign(roll);
+
+ // Clamp the maximum steering rate to 30 degrees per second,
+ // But only do this when the heading error is decreasing.
+ if ((headingDiff < headingError)) {
+ if (headingChangeRate > 30)
+ headingChangeRate = 30;
+ else if (headingChangeRate < -30)
+ headingChangeRate = -30;
+ }
} else {
- if (fabs(headingChangeRate) > headingDiff)
- headingChangeRate = headingDiff*sign(roll);
- else
- headingChangeRate += dt * sign(roll);
+ if (fabs(headingChangeRate) > headingDiff)
+ headingChangeRate = headingDiff*sign(roll);
+ else
+ headingChangeRate += dt * sign(roll);
}
- hdg += headingChangeRate * dt;
+ hdg += headingChangeRate * dt;
+ headingError = headingDiff;
} else {
if (fabs(speed) > 1.0) {
turn_radius_ft = 0.088362 * speed * speed
projects / flightgear.git / blobdiff