X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FNetwork%2Fatlas.cxx;h=d5712f02e6fc75f93c44b6c746ec831a83e9909e;hb=fce2a53fc7cf5fb8e392a5e0570ad81f24e3ab0c;hp=f0738a12f208e42ed3ab8009a8b11353c4b3861a;hpb=7ad2bee1a8b3064ea6a3c5b2e684b2d39d3ecf1b;p=flightgear.git diff --git a/src/Network/atlas.cxx b/src/Network/atlas.cxx index f0738a12f..d5712f02e 100644 --- a/src/Network/atlas.cxx +++ b/src/Network/atlas.cxx @@ -24,14 +24,16 @@ # include "config.h" #endif +#include +#include +#include + #include #include #include +#include - - - -#include +#include #include
#include
#include
@@ -39,10 +41,19 @@ #include "atlas.hxx" -FGAtlas::FGAtlas() { +FGAtlas::FGAtlas() : + length(0), + fdm(new FlightProperties) +{ + _adf_freq = fgGetNode("/instrumentation/adf/frequencies/selected-khz", true); + _nav1_freq = fgGetNode("/instrumentation/nav/frequencies/selected-mhz", true); + _nav1_sel_radial = fgGetNode("/instrumentation/nav/radials/selected-deg", true); + _nav2_freq = fgGetNode("/instrumentation/nav[1]/frequencies/selected-mhz", true); + _nav2_sel_radial = fgGetNode("/instrumentation/nav[1]/radials/selected-deg", true); } FGAtlas::~FGAtlas() { + delete fdm; } @@ -65,22 +76,9 @@ static char calc_atlas_cksum(char *sentence) { return sum; } - // generate Atlas message bool FGAtlas::gen_message() { // cout << "generating atlas message" << endl; - - static SGPropertyNode *adf_freq - = fgGetNode("/instrumentation/adf/frequencies/selected-khz", true); - static SGPropertyNode *nav1_freq - = fgGetNode("/instrumentation/nav/frequencies/selected-mhz", true); - static SGPropertyNode *nav1_sel_radial - = fgGetNode("/instrumentation/nav/radials/selected-deg", true); - static SGPropertyNode *nav2_freq - = fgGetNode("/instrumentation/nav[1]/frequencies/selected-mhz", true); - static SGPropertyNode *nav2_sel_radial - = fgGetNode("/instrumentation/nav[1]/radials/selected-deg", true); - char rmc[256], gga[256], patla[256]; char rmc_sum[10], gga_sum[10], patla_sum[10]; char dir; @@ -94,7 +92,7 @@ bool FGAtlas::gen_message() { t->getGmt()->tm_hour, t->getGmt()->tm_min, t->getGmt()->tm_sec ); char lat[20]; - double latd = cur_fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES; + double latd = fdm->get_Latitude() * SGD_RADIANS_TO_DEGREES; if ( latd < 0.0 ) { latd *= -1.0; dir = 'S'; @@ -106,7 +104,7 @@ bool FGAtlas::gen_message() { sprintf( lat, "%02d%06.3f,%c", abs(deg), min, dir); char lon[20]; - double lond = cur_fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES; + double lond = fdm->get_Longitude() * SGD_RADIANS_TO_DEGREES; if ( lond < 0.0 ) { lond *= -1.0; dir = 'W'; @@ -118,17 +116,17 @@ bool FGAtlas::gen_message() { sprintf( lon, "%03d%06.3f,%c", abs(deg), min, dir); char speed[10]; - sprintf( speed, "%05.1f", cur_fdm_state->get_V_equiv_kts() ); + sprintf( speed, "%05.1f", fdm->get_V_equiv_kts() ); char heading[10]; - sprintf( heading, "%05.1f", cur_fdm_state->get_Psi() * SGD_RADIANS_TO_DEGREES ); + sprintf( heading, "%05.1f", fdm->get_Psi() * SGD_RADIANS_TO_DEGREES ); char altitude_m[10]; sprintf( altitude_m, "%02d", - (int)(cur_fdm_state->get_Altitude() * SG_FEET_TO_METER) ); + (int)(fdm->get_Altitude() * SG_FEET_TO_METER) ); char altitude_ft[10]; - sprintf( altitude_ft, "%02d", (int)cur_fdm_state->get_Altitude() ); + sprintf( altitude_ft, "%02d", (int)fdm->get_Altitude() ); char date[10]; sprintf( date, "%02d%02d%02d", t->getGmt()->tm_mday, @@ -144,11 +142,11 @@ bool FGAtlas::gen_message() { sprintf( gga_sum, "%02X", calc_atlas_cksum(gga) ); sprintf( patla, "PATLA,%.2f,%.1f,%.2f,%.1f,%.0f", - nav1_freq->getDoubleValue(), - nav1_sel_radial->getDoubleValue(), - nav2_freq->getDoubleValue(), - nav2_sel_radial->getDoubleValue(), - adf_freq->getDoubleValue() ); + _nav1_freq->getDoubleValue(), + _nav1_sel_radial->getDoubleValue(), + _nav2_freq->getDoubleValue(), + _nav2_sel_radial->getDoubleValue(), + _adf_freq->getDoubleValue() ); sprintf( patla_sum, "%02X", calc_atlas_cksum(patla) ); SG_LOG( SG_IO, SG_DEBUG, rmc ); @@ -275,7 +273,7 @@ bool FGAtlas::parse_message() { lat *= -1; } - cur_fdm_state->set_Latitude( lat * SGD_DEGREES_TO_RADIANS ); + fdm->set_Latitude( lat * SGD_DEGREES_TO_RADIANS ); SG_LOG( SG_IO, SG_INFO, " lat = " << lat ); // lon val @@ -304,17 +302,17 @@ bool FGAtlas::parse_message() { lon *= -1; } - cur_fdm_state->set_Longitude( lon * SGD_DEGREES_TO_RADIANS ); + fdm->set_Longitude( lon * SGD_DEGREES_TO_RADIANS ); SG_LOG( SG_IO, SG_INFO, " lon = " << lon ); #if 0 double sl_radius, lat_geoc; - sgGeodToGeoc( cur_fdm_state->get_Latitude(), - cur_fdm_state->get_Altitude(), + sgGeodToGeoc( fdm->get_Latitude(), + fdm->get_Altitude(), &sl_radius, &lat_geoc ); - cur_fdm_state->set_Geocentric_Position( lat_geoc, - cur_fdm_state->get_Longitude(), - sl_radius + cur_fdm_state->get_Altitude() ); + fdm->set_Geocentric_Position( lat_geoc, + fdm->get_Longitude(), + sl_radius + fdm->get_Altitude() ); #endif // speed @@ -326,8 +324,8 @@ bool FGAtlas::parse_message() { string speed_str = msg.substr(begin, end - begin); begin = end + 1; speed = atof( speed_str.c_str() ); - cur_fdm_state->set_V_calibrated_kts( speed ); - // cur_fdm_state->set_V_ground_speed( speed ); + fdm->set_V_calibrated_kts( speed ); + // fdm->set_V_ground_speed( speed ); SG_LOG( SG_IO, SG_INFO, " speed = " << speed ); // heading @@ -339,8 +337,8 @@ bool FGAtlas::parse_message() { string hdg_str = msg.substr(begin, end - begin); begin = end + 1; heading = atof( hdg_str.c_str() ); - cur_fdm_state->set_Euler_Angles( cur_fdm_state->get_Phi(), - cur_fdm_state->get_Theta(), + fdm->set_Euler_Angles( fdm->get_Phi(), + fdm->get_Theta(), heading * SGD_DEGREES_TO_RADIANS ); SG_LOG( SG_IO, SG_INFO, " heading = " << heading ); } else if ( sentence == "GPGGA" ) { @@ -380,7 +378,7 @@ bool FGAtlas::parse_message() { lat *= -1; } - // cur_fdm_state->set_Latitude( lat * SGD_DEGREES_TO_RADIANS ); + // fdm->set_Latitude( lat * SGD_DEGREES_TO_RADIANS ); SG_LOG( SG_IO, SG_INFO, " lat = " << lat ); // lon val @@ -409,7 +407,7 @@ bool FGAtlas::parse_message() { lon *= -1; } - // cur_fdm_state->set_Longitude( lon * SGD_DEGREES_TO_RADIANS ); + // fdm->set_Longitude( lon * SGD_DEGREES_TO_RADIANS ); SG_LOG( SG_IO, SG_INFO, " lon = " << lon ); // junk @@ -465,7 +463,7 @@ bool FGAtlas::parse_message() { altitude *= SG_METER_TO_FEET; } - cur_fdm_state->set_Altitude( altitude ); + fdm->set_Altitude( altitude ); SG_LOG( SG_IO, SG_INFO, " altitude = " << altitude );