fly/flightgear
1
0
Fork 0
Code Activity

Maintenance: AIFlightPlan

Browse source 
shortenToFirst() 'name' parameter to const&.
use const functions when appropriate.
This commit is contained in:
scttgs0 2023-05-21 20:31:52 -05:00
parent 6284ab6268
commit 4413bcc7ed
2 changed files with 243 additions and 245 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

130
src/AIModel/AIFlightPlan.cxx
View file

@ -6,11 +6,11 @@
*/
#ifdef HAVE_CONFIG_H
# include <config.h>
#include <config.h>
#endif
#include <iterator>
#include <algorithm>
#include <iterator>
#include <simgear/constants.h>
#include <simgear/debug/logstream.hxx>
@ -22,25 +22,26 @@
#include <simgear/structure/exception.hxx>
#include <simgear/timing/sg_time.hxx>
#include <Main/globals.hxx>
#include <Main/fg_props.hxx>
#include <Main/fg_init.hxx>
#include <Airports/airport.hxx>
#include <Airports/dynamics.hxx>
#include <Airports/runways.hxx>
#include <Airports/groundnetwork.hxx>
#include <Airports/runways.hxx>
#include <Main/fg_init.hxx>
#include <Main/fg_props.hxx>
#include <Main/globals.hxx>
#include <Environment/environment_mgr.hxx>
#include <Environment/environment.hxx>
#include <Environment/environment_mgr.hxx>
#include <Traffic/Schedule.hxx>
#include "AIFlightPlan.hxx"
#include "AIAircraft.hxx"
#include "AIFlightPlan.hxx"
using std::string;
FGAIWaypoint::FGAIWaypoint() {
FGAIWaypoint::FGAIWaypoint()
{
speed = 0;
crossat = 0;
finished = 0;
@ -52,7 +53,8 @@ FGAIWaypoint::FGAIWaypoint() {
trackLength = 0;
}
bool FGAIWaypoint::contains(const string& target) {
bool FGAIWaypoint::contains(const string& target)
{
size_t found = name.find(target);
if (found == string::npos)
return false;
@ -60,17 +62,17 @@ bool FGAIWaypoint::contains(const string& target) {
return true;
}
double FGAIWaypoint::getLatitude()
double FGAIWaypoint::getLatitude() const
{
return pos.getLatitudeDeg();
}
double FGAIWaypoint::getLongitude()
double FGAIWaypoint::getLongitude() const
{
return pos.getLongitudeDeg();
}
double FGAIWaypoint::getAltitude()
double FGAIWaypoint::getAltitude() const
{
return pos.getElevationFt();
}
@ -90,8 +92,7 @@ void FGAIWaypoint::setAltitude(double alt)
pos.setElevationFt(alt);
}
FGAIFlightPlan::FGAIFlightPlan() :
sid(NULL),
FGAIFlightPlan::FGAIFlightPlan() : sid(NULL),
repeat(false),
distance_to_go(0),
lead_distance_ft(0),
@ -105,8 +106,7 @@ FGAIFlightPlan::FGAIFlightPlan() :
wpt_iterator = waypoints.begin();
}
FGAIFlightPlan::FGAIFlightPlan(const string& filename) :
sid(NULL),
FGAIFlightPlan::FGAIFlightPlan(const string& filename) : sid(NULL),
repeat(false),
distance_to_go(0),
lead_distance_ft(0),
@ -128,13 +128,13 @@ FGAIFlightPlan::FGAIFlightPlan(const string& filename) :
* as setting speeds and altitude computed by the
* traffic manager.
*/
FGAIFlightPlan::FGAIFlightPlan(FGAIAircraft *ac,
FGAIFlightPlan::FGAIFlightPlan(FGAIAircraft* ac,
const std::string& p,
double course,
time_t start,
time_t remainingTime,
FGAirport *dep,
FGAirport *arr,
FGAirport* dep,
FGAirport* arr,
bool firstLeg,
double radius,
double alt,
@ -143,8 +143,7 @@ FGAIFlightPlan::FGAIFlightPlan(FGAIAircraft *ac,
double speed,
const string& fltType,
const string& acType,
const string& airline) :
sid(NULL),
const string& airline) : sid(NULL),
repeat(false),
distance_to_go(0),
lead_distance_ft(0),
@ -171,12 +170,12 @@ FGAIFlightPlan::~FGAIFlightPlan()
//delete taxiRoute;
}
void FGAIFlightPlan::createWaypoints(FGAIAircraft *ac,
void FGAIFlightPlan::createWaypoints(FGAIAircraft* ac,
double course,
time_t start,
time_t remainingTime,
FGAirport *dep,
FGAirport *arr,
FGAirport* dep,
FGAirport* arr,
bool firstLeg,
double radius,
double alt,
@ -188,7 +187,7 @@ void FGAIFlightPlan::createWaypoints(FGAIAircraft *ac,
const string& airline)
{
time_t now = globals->get_time_params()->get_cur_time();
time_t timeDiff = now-start;
time_t timeDiff = now - start;
leg = AILeg::STARTUP_PUSHBACK;
if ((timeDiff > 60) && (timeDiff < 1500))
@ -203,8 +202,7 @@ void FGAIFlightPlan::createWaypoints(FGAIAircraft *ac,
}
}
SG_LOG(SG_AI, SG_DEBUG, ac->getTrafficRef()->getCallSign() << "|Route from " << dep->getId() << " to " << arr->getId() <<
". Set leg to : " << leg << " " << remainingTime);
SG_LOG(SG_AI, SG_DEBUG, ac->getTrafficRef()->getCallSign() << "|Route from " << dep->getId() << " to " << arr->getId() << ". Set leg to : " << leg << " " << remainingTime);
wpt_iterator = waypoints.begin();
bool dist = 0;
@ -307,7 +305,7 @@ bool FGAIFlightPlan::readFlightplan(std::istream& stream, const sg_location& loc
return true;
}
FGAIWaypoint* FGAIFlightPlan::getLastWaypoint()
FGAIWaypoint* FGAIFlightPlan::getLastWaypoint() const
{
if (waypoints.empty())
return nullptr;
@ -315,7 +313,7 @@ FGAIWaypoint* FGAIFlightPlan::getLastWaypoint()
return waypoints.back();
};
FGAIWaypoint* FGAIFlightPlan::getPreviousWaypoint( void ) const
FGAIWaypoint* FGAIFlightPlan::getPreviousWaypoint() const
{
if (empty())
return nullptr;
@ -328,14 +326,14 @@ FGAIWaypoint* FGAIFlightPlan::getPreviousWaypoint( void ) const
}
}
FGAIWaypoint* FGAIFlightPlan::getCurrentWaypoint( void ) const
FGAIWaypoint* FGAIFlightPlan::getCurrentWaypoint() const
{
if (wpt_iterator == waypoints.end())
return nullptr;
return *wpt_iterator;
}
FGAIWaypoint* FGAIFlightPlan::getNextWaypoint( void ) const
FGAIWaypoint* FGAIFlightPlan::getNextWaypoint() const
{
if (wpt_iterator == waypoints.end())
return nullptr;
@ -348,31 +346,27 @@ FGAIWaypoint* FGAIFlightPlan::getNextWaypoint( void ) const
}
}
int FGAIFlightPlan::getNextTurnAngle( void ) const
int FGAIFlightPlan::getNextTurnAngle() const
{
return nextTurnAngle;
}
void FGAIFlightPlan::IncrementWaypoint(bool eraseWaypoints )
void FGAIFlightPlan::IncrementWaypoint(bool eraseWaypoints)
{
if (empty())
return;
if (eraseWaypoints)
{
if (eraseWaypoints) {
if (wpt_iterator == waypoints.begin())
++wpt_iterator;
else
if (!waypoints.empty())
{
else if (!waypoints.empty()) {
delete *(waypoints.begin());
waypoints.erase(waypoints.begin());
wpt_iterator = waypoints.begin();
++wpt_iterator;
}
}
else {
} else {
++wpt_iterator;
}
// Calculate the angle of the next turn.
@ -380,11 +374,11 @@ void FGAIFlightPlan::IncrementWaypoint(bool eraseWaypoints )
return;
if (wpt_iterator == waypoints.begin())
return;
if (wpt_iterator+1 == waypoints.end())
if (wpt_iterator + 1 == waypoints.end())
return;
if (waypoints.size()<3)
if (waypoints.size() < 3)
return;
FGAIWaypoint* previousWP = *(wpt_iterator -1);
FGAIWaypoint* previousWP = *(wpt_iterator - 1);
FGAIWaypoint* currentWP = *(wpt_iterator);
FGAIWaypoint* nextWP = *(wpt_iterator + 1);
int currentBearing = this->getBearing(previousWP, currentWP);
@ -413,13 +407,14 @@ void FGAIFlightPlan::eraseLastWaypoint()
return;
delete (waypoints.back());
waypoints.pop_back();;
waypoints.pop_back();
wpt_iterator = waypoints.begin();
++wpt_iterator;
}
// gives distance in meters from a position to a waypoint
double FGAIFlightPlan::getDistanceToGo(double lat, double lon, FGAIWaypoint* wp) const{
double FGAIFlightPlan::getDistanceToGo(double lat, double lon, FGAIWaypoint* wp) const
{
return SGGeodesy::distanceM(SGGeod::fromDeg(lon, lat), wp->getPos());
}
@ -430,7 +425,8 @@ double FGAIFlightPlan::getDistanceToGo(double lat, double lon, FGAIWaypoint* wp)
void FGAIFlightPlan::setLeadDistance(double speed,
double bearing,
FGAIWaypoint* current,
FGAIWaypoint* next){
FGAIWaypoint* next)
{
double turn_radius_m;
// Handle Ground steering
// At a turn rate of 30 degrees per second, it takes 12 seconds to do a full 360 degree turn
@ -443,13 +439,13 @@ void FGAIFlightPlan::setLeadDistance(double speed,
}
if (speed > 0 && speed < 0.5) {
setLeadDistance(5 * SG_METER_TO_FEET);
SG_LOG(SG_AI, SG_BULK, "Setting Leaddistance fixed " << (lead_distance_ft*SG_FEET_TO_METER));
SG_LOG(SG_AI, SG_BULK, "Setting Leaddistance fixed " << (lead_distance_ft * SG_FEET_TO_METER));
return;
}
double speed_mps = speed * SG_KT_TO_MPS;
if (speed < 25) {
turn_radius_m = ((360/30)*fabs(speed_mps)) / (2*M_PI);
turn_radius_m = ((360 / 30) * fabs(speed_mps)) / (2 * M_PI);
} else {
turn_radius_m = 0.1911 * speed * speed; // an estimate for 25 degrees bank
}
@ -463,16 +459,16 @@ void FGAIFlightPlan::setLeadDistance(double speed,
//lead_distance_ft = turn_radius * sin(leadInAngle * SG_DEGREES_TO_RADIANS);
if ((int)leadInAngle==0) {
double lead_distance_m = fabs(2*speed) * SG_FEET_TO_METER;
if ((int)leadInAngle == 0) {
double lead_distance_m = fabs(2 * speed) * SG_FEET_TO_METER;
setLeadDistance(lead_distance_m * SG_METER_TO_FEET);
if (lead_distance_ft > 1000) {
SG_LOG(SG_AI, SG_BULK, "Excessive leaddistance leadin 0 " << lead_distance_ft << " leadInAngle " << leadInAngle << " inbound " << inbound << " outbound " << outbound);
}
} else {
double lead_distance_m = turn_radius_m * tan((leadInAngle * SG_DEGREES_TO_RADIANS)/2);
double lead_distance_m = turn_radius_m * tan((leadInAngle * SG_DEGREES_TO_RADIANS) / 2);
setLeadDistance(lead_distance_m * SG_METER_TO_FEET);
SG_LOG(SG_AI, SG_BULK, "Setting Leaddistance " << (lead_distance_ft*SG_FEET_TO_METER) << " Turnradius " << turn_radius_m << " Speed " << speed_mps << " Half turn Angle " << (leadInAngle)/2);
SG_LOG(SG_AI, SG_BULK, "Setting Leaddistance " << (lead_distance_ft * SG_FEET_TO_METER) << " Turnradius " << turn_radius_m << " Speed " << speed_mps << " Half turn Angle " << (leadInAngle) / 2);
if (lead_distance_ft > 1000) {
SG_LOG(SG_AI, SG_BULK, "Excessive leaddistance possible direction change " << lead_distance_ft << " leadInAngle " << leadInAngle << " inbound " << inbound << " outbound " << outbound << " at " << current->getName());
}
@ -491,9 +487,10 @@ void FGAIFlightPlan::setLeadDistance(double speed,
}*/
}
void FGAIFlightPlan::setLeadDistance(double distance_ft){
void FGAIFlightPlan::setLeadDistance(double distance_ft)
{
lead_distance_ft = distance_ft;
if (lead_distance_ft>10000) {
if (lead_distance_ft > 10000) {
SG_LOG(SG_AI, SG_BULK, "Excessive Leaddistance " << distance_ft);
}
}
@ -552,15 +549,15 @@ void FGAIFlightPlan::addWaypoint(FGAIWaypoint* wpt)
pushBackWaypoint(wpt);
}
void FGAIFlightPlan::pushBackWaypoint(FGAIWaypoint *wpt)
void FGAIFlightPlan::pushBackWaypoint(FGAIWaypoint* wpt)
{
if (!wpt) {
SG_LOG(SG_AI, SG_WARN, "Null WPT added");
}
size_t pos = wpt_iterator - waypoints.begin();
if (waypoints.size()>0) {
double dist = SGGeodesy::distanceM( waypoints.back()->getPos(), wpt->getPos());
if( dist == 0 ) {
if (waypoints.size() > 0) {
double dist = SGGeodesy::distanceM(waypoints.back()->getPos(), wpt->getPos());
if (dist == 0) {
SG_LOG(SG_AI, SG_DEBUG, "Double WP : \t" << wpt->getName() << " not added ");
} else {
waypoints.push_back(wpt);
@ -582,22 +579,23 @@ void FGAIFlightPlan::restart()
wpt_iterator = waypoints.begin();
}
int FGAIFlightPlan::getRouteIndex(int i) {
int FGAIFlightPlan::getRouteIndex(int i) const
{
if ((i > 0) && (i < (int)waypoints.size())) {
return waypoints[i]->getRouteIndex();
}
else
} else
return 0;
}
double FGAIFlightPlan::checkTrackLength(const string& wptName) const {
double FGAIFlightPlan::checkTrackLength(const string& wptName) const
{
// skip the first two waypoints: first one is behind, second one is partially done;
double trackDistance = 0;
wpt_vector_iterator wptvec = waypoints.begin();
++wptvec;
++wptvec;
while ((wptvec != waypoints.end())) {
if (*wptvec!=nullptr && (!((*wptvec)->contains(wptName)))) {
if (*wptvec != nullptr && (!((*wptvec)->contains(wptName)))) {
break;
}
trackDistance += (*wptvec)->getTrackLength();
@ -609,7 +607,7 @@ double FGAIFlightPlan::checkTrackLength(const string& wptName) const {
return trackDistance;
}
void FGAIFlightPlan::shortenToFirst(unsigned int number, string name)
void FGAIFlightPlan::shortenToFirst(unsigned int number, const std::string& name)
{
while (waypoints.size() > number + 3) {
eraseLastWaypoint();
@ -622,7 +620,7 @@ void FGAIFlightPlan::setGate(const ParkingAssignment& pka)
gate = pka;
}
FGParking* FGAIFlightPlan::getParkingGate()
FGParking* FGAIFlightPlan::getParkingGate() const
{
return gate.parking();
}

14
src/AIModel/AIFlightPlan.hxx
View file

@ -93,9 +93,9 @@ public:
const std::string& getName() { return name; };
const SGGeod& getPos() { return pos; };
double getLatitude();
double getLongitude();
double getAltitude();
double getLatitude() const;
double getLongitude() const;
double getAltitude() const;
double getSpeed() { return speed; };
double getCrossat() { return crossat; };
@ -198,7 +198,7 @@ public:
void restart(void);
int getNrOfWayPoints() { return waypoints.size(); }
int getRouteIndex(int i); // returns the AI related index of this current routes.
int getRouteIndex(int i) const; // returns the AI related index of this current routes.
const std::string& getRunway() { return activeRunway; }
bool isActive(time_t time) { return time >= this->getStartTime(); }
@ -220,12 +220,12 @@ public:
void setSID(FGAIFlightPlan* fp) { sid = fp; };
FGAIFlightPlan* getSID() { return sid; };
FGAIWaypoint* getWayPoint(int i) { return waypoints[i]; };
FGAIWaypoint* getLastWaypoint();
FGAIWaypoint* getLastWaypoint() const;
void shortenToFirst(unsigned int number, std::string name);
void shortenToFirst(unsigned int number, const std::string& name);
void setGate(const ParkingAssignment& pka);
FGParking* getParkingGate();
FGParking* getParkingGate() const;
FGAirportRef departureAirport() const;
FGAirportRef arrivalAirport() const;