X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fwxradar.cxx;h=b1f81be656ebf2e293ba902f662e6331943a4990;hb=805c4cbba15c6922e511b3a20ba5a9cb56ceed4f;hp=613a3c24372c9e69349666cda0c327ebfb543a3c;hpb=eb2a167331807d0800fe3312f0a9994584444880;p=flightgear.git diff --git a/src/Instrumentation/wxradar.cxx b/src/Instrumentation/wxradar.cxx index 613a3c243..b1f81be65 100644 --- a/src/Instrumentation/wxradar.cxx +++ b/src/Instrumentation/wxradar.cxx @@ -38,7 +38,6 @@ #include #include -#include #include #include #include @@ -46,46 +45,53 @@ #include #include -SG_USING_STD(stringstream); -SG_USING_STD(endl); -SG_USING_STD(setprecision); -SG_USING_STD(fixed); -SG_USING_STD(setw); -SG_USING_STD(setfill); + +using std::stringstream; +using std::endl; +using std::setprecision; +using std::fixed; +using std::setw; +using std::setfill; +using std::string; #include
#include
#include -#include -#include -#include -#include -#include #include "instrument_mgr.hxx" #include "od_gauge.hxx" #include "wxradar.hxx" +#include // for cout, endl -typedef list > radar_list_type; -typedef radar_list_type::iterator radar_list_iterator; -typedef radar_list_type::const_iterator radar_list_const_iterator; - +using std::cout; +using std::endl; static const float UNIT = 1.0f / 8.0f; // 8 symbols in a row/column in the texture static const char *DEFAULT_FONT = "typewriter.txf"; - wxRadarBg::wxRadarBg(SGPropertyNode *node) : _name(node->getStringValue("name", "radar")), _num(node->getIntValue("number", 0)), - _interval(node->getDoubleValue("update-interval-sec", 1.0)), _time(0.0), - _sim_init_done(false), + _interval(node->getDoubleValue("update-interval-sec", 1.0)), + _elapsed_time(0), + _persistance(0), _odg(0), - _last_switchKnob("off"), + _range_nm(0), + _scale(0), + _angle_offset(0), + _view_heading(0), + _x_offset(0), + _y_offset(0), + _radar_ref_rng(0), + _lat(0), + _lon(0), + _antenna_ht(node->getDoubleValue("antenna-ht-ft", 0.0)), _resultTexture(0), - _wxEcho(0) + _wxEcho(0), + _font_size(0), + _font_spacing(0) { string branch; branch = "/instrumentation/" + _name; @@ -113,6 +119,7 @@ wxRadarBg::wxRadarBg(SGPropertyNode *node) : wxRadarBg::~wxRadarBg () { _font_node->removeChangeListener(this); + delete _odg; } @@ -120,19 +127,19 @@ void wxRadarBg::init () { _serviceable_node = _Instrument->getNode("serviceable", true); + _sceneryLoaded = fgGetNode("/sim/sceneryloaded", true); // texture name to use in 2D and 3D instruments _texture_path = _Instrument->getStringValue("radar-texture-path", - "Aircraft/Instruments/Textures/od_wxradar.rgb"); + "Aircraft/Instruments/Textures/od_wxradar.rgb"); _resultTexture = FGTextureManager::createTexture(_texture_path.c_str(), false); - SGPath tpath(globals->get_fg_root()); string path = _Instrument->getStringValue("echo-texture-path", - "Aircraft/Instruments/Textures/wxecho.rgb"); - tpath.append(path); + "Aircraft/Instruments/Textures/wxecho.rgb"); + SGPath tpath = globals->resolve_aircraft_path(path); // no mipmap or else alpha will mix with pixels on the border of shapes, ruining the effect - _wxEcho = SGLoadTexture2D(tpath, false, false); + _wxEcho = SGLoadTexture2D(tpath, NULL, false, false); _Instrument->setFloatValue("trk", 0.0); @@ -149,11 +156,9 @@ wxRadarBg::init () // input range = n nm (20/40/80) // input display-mode = arc | rose | map | plan - FGInstrumentMgr *imgr = (FGInstrumentMgr *)globals->get_subsystem("instrumentation"); - _odg = (FGODGauge *)imgr->get_subsystem("od_gauge"); + _odg = new FGODGauge; _odg->setSize(512); - _ai = (FGAIManager*)globals->get_subsystem("ai_model"); _ai_enabled_node = fgGetNode("/sim/ai/enabled", true); _user_lat_node = fgGetNode("/position/latitude-deg", true); @@ -181,6 +186,8 @@ wxRadarBg::init () _radar_symbol_node = n->getNode("symbol", true); _radar_centre_node = n->getNode("centre", true); _radar_rotate_node = n->getNode("rotate", true); + _radar_tcas_node = n->getNode("tcas", true); + _radar_absalt_node = n->getNode("abs-altitude", true); _radar_centre_node->setBoolValue(false); if (!_radar_coverage_node->hasValue()) @@ -227,7 +234,7 @@ wxRadarBg::init () pset->setDataVariance(osg::Object::DYNAMIC); _geom->addPrimitiveSet(pset); _geom->setInitialBound(osg::BoundingBox(osg::Vec3f(-256.0f, -256.0f, 0.0f), - osg::Vec3f(256.0f, 256.0f, 0.0f))); + osg::Vec3f(256.0f, 256.0f, 0.0f))); _radarGeode->addDrawable(_geom); _odg->allocRT(); // Texture in the 2D panel system @@ -238,6 +245,8 @@ wxRadarBg::init () osg::Camera *camera = _odg->getCamera(); camera->addChild(_radarGeode.get()); camera->addChild(_textGeode.get()); + + updateFont(); } @@ -278,16 +287,14 @@ osg::Matrixf wxRotate(float angle) void wxRadarBg::update (double delta_time_sec) { - if (!_sim_init_done) { - if (!fgGetBool("sim/sceneryloaded", false)) - return; + if (!_sceneryLoaded->getBoolValue()) + return; - _sim_init_done = true; - } if (!_odg || !_serviceable_node->getBoolValue()) { _Instrument->setStringValue("status", ""); return; } + _time += delta_time_sec; if (_time < _interval) return; @@ -301,22 +308,14 @@ wxRadarBg::update (double delta_time_sec) center_map(); } } else if (mode == "plan") { - _display_mode = PLAN; + _display_mode = PLAN;} + else if (mode == "bscan") { + _display_mode = BSCAN; } else { _display_mode = ARC; } string switchKnob = _Instrument->getStringValue("switch", "on"); - if (_last_switchKnob != switchKnob) { - // since 3D models don't share textures with the rest of the world - // we must locate them and replace their handle by hand - // only do that when the instrument is turned on - //if (_last_switchKnob == "off") - //_odg->set_texture(_texture_path.c_str(), _resultTexture->getHandle()); - - _last_switchKnob = switchKnob; - } - if (switchKnob == "off") { _Instrument->setStringValue("status", ""); } else if (switchKnob == "stby") { @@ -332,7 +331,7 @@ wxRadarBg::update (double delta_time_sec) } _radar_ref_rng = _radar_ref_rng_node->getDoubleValue(); - _view_heading = get_heading() * SG_DEGREES_TO_RADIANS; + _view_heading = fgGetDouble("/orientation/heading-deg") * SG_DEGREES_TO_RADIANS; _centerTrans.makeTranslate(0.0f, 0.0f, 0.0f); _scale = 200.0 / _range_nm; @@ -352,7 +351,7 @@ wxRadarBg::update (double delta_time_sec) _radar_centre_node->setBoolValue(false); } - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: displacement " + //SG_LOG(SG_INSTR, SG_DEBUG, "Radar: displacement " // << _x_offset <<", "<<_y_offset // << " user_speed_east_fps * SG_FPS_TO_KT " // << user_speed_east_fps * SG_FPS_TO_KT @@ -366,6 +365,8 @@ wxRadarBg::update (double delta_time_sec) if (_radar_rotate_node->getBoolValue()) { _angle_offset = -_view_heading; } + } else if (_display_mode == BSCAN) { + _angle_offset = -_view_heading; } else { // rose } @@ -374,90 +375,99 @@ wxRadarBg::update (double delta_time_sec) _texCoords->clear(); _textGeode->removeDrawables(0, _textGeode->getNumDrawables()); - - update_weather(); - - - osg::DrawArrays *quadPSet - = static_cast(_geom->getPrimitiveSet(0)); - quadPSet->set(osg::PrimitiveSet::QUADS, 0, _vertices->size()); - quadPSet->dirty(); - - // erase what is out of sight of antenna - /* - |\ /| - | \ / | - | \ / | - --------- - | | - | | - --------- - */ - - osg::DrawArrays *maskPSet +#if 0 + //TODO FIXME Mask below (only used for ARC mode) isn't properly aligned, i.e. + // it assumes the a/c position at the center of the display - though it's somewhere at + // bottom part for ARC mode. + // The mask hadn't worked at all for a while (probably since the OSG port) due to + // another bug (which is fixed now). Now, the mask is disabled completely until s.o. + // adapted the coordinates below. And the mask is only really useful to limit displayed + // weather blobs (not support yet). + // Aircraft echos are already limited properly through wxradar's "limit-deg" property. + { + osg::DrawArrays *maskPSet = static_cast(_geom->getPrimitiveSet(1)); - osg::DrawArrays *trimaskPSet + osg::DrawArrays *trimaskPSet = static_cast(_geom->getPrimitiveSet(2)); - if (_display_mode == ARC) { - float xOffset = 256.0f; - float yOffset = 200.0f; - - int firstQuadVert = _vertices->size(); - _texCoords->push_back(osg::Vec2f(0.5f, 0.25f)); - _vertices->push_back(osg::Vec2f(-xOffset, 0.0 + yOffset)); - _texCoords->push_back(osg::Vec2f(1.0f, 0.25f)); - _vertices->push_back(osg::Vec2f(xOffset, 0.0 + yOffset)); - _texCoords->push_back(osg::Vec2f(1.0f, 0.5f)); - _vertices->push_back(osg::Vec2f(xOffset, 256.0 + yOffset)); - _texCoords->push_back(osg::Vec2f(0.5f, 0.5f)); - _vertices->push_back(osg::Vec2f(-xOffset, 256.0 + yOffset)); - maskPSet->set(osg::PrimitiveSet::QUADS, firstQuadVert, 4); - - // The triangles aren't supposed to be textured, but there's - // no need to set up a different Geometry, switch modes, - // etc. I happen to know that there's a white pixel in the - // texture at 1.0, 0.0 :) - float centerY = tan(30 * SG_DEGREES_TO_RADIANS); - _vertices->push_back(osg::Vec2f(0.0, 0.0)); - _vertices->push_back(osg::Vec2f(-256.0, 0.0)); - _vertices->push_back(osg::Vec2f(-256.0, 256.0 * centerY)); - - _vertices->push_back(osg::Vec2f(0.0, 0.0)); - _vertices->push_back(osg::Vec2f(256.0, 0.0)); - _vertices->push_back(osg::Vec2f(256.0, 256.0 * centerY)); - - _vertices->push_back(osg::Vec2f(-256, 0.0)); - _vertices->push_back(osg::Vec2f(256.0, 0.0)); - _vertices->push_back(osg::Vec2f(-256.0, -256.0)); - - _vertices->push_back(osg::Vec2f(256, 0.0)); - _vertices->push_back(osg::Vec2f(256.0, -256.0)); - _vertices->push_back(osg::Vec2f(-256.0, -256.0)); - - const osg::Vec2f whiteSpot(1.0f, 0.0f); - for (int i = 0; i < 3 * 4; i++) - _texCoords->push_back(whiteSpot); - - trimaskPSet->set(osg::PrimitiveSet::TRIANGLES, firstQuadVert + 4, 3 * 4); + if (_display_mode == ARC) { + // erase what is out of sight of antenna + /* + |\ /| + | \ / | + | \ / | + --------- + | | + | | + --------- + */ + float xOffset = 256.0f; + float yOffset = 200.0f; + + int firstQuadVert = _vertices->size(); + _texCoords->push_back(osg::Vec2f(0.5f, 0.25f)); + _vertices->push_back(osg::Vec2f(-xOffset, 0.0 + yOffset)); + _texCoords->push_back(osg::Vec2f(1.0f, 0.25f)); + _vertices->push_back(osg::Vec2f(xOffset, 0.0 + yOffset)); + _texCoords->push_back(osg::Vec2f(1.0f, 0.5f)); + _vertices->push_back(osg::Vec2f(xOffset, 256.0 + yOffset)); + _texCoords->push_back(osg::Vec2f(0.5f, 0.5f)); + _vertices->push_back(osg::Vec2f(-xOffset, 256.0 + yOffset)); + maskPSet->set(osg::PrimitiveSet::QUADS, firstQuadVert, 4); + firstQuadVert += 4; + + // The triangles aren't supposed to be textured, but there's + // no need to set up a different Geometry, switch modes, + // etc. I happen to know that there's a white pixel in the + // texture at 1.0, 0.0 :) + float centerY = tan(30 * SG_DEGREES_TO_RADIANS); + _vertices->push_back(osg::Vec2f(0.0, 0.0)); + _vertices->push_back(osg::Vec2f(-256.0, 0.0)); + _vertices->push_back(osg::Vec2f(-256.0, 256.0 * centerY)); + + _vertices->push_back(osg::Vec2f(0.0, 0.0)); + _vertices->push_back(osg::Vec2f(256.0, 0.0)); + _vertices->push_back(osg::Vec2f(256.0, 256.0 * centerY)); + + _vertices->push_back(osg::Vec2f(-256, 0.0)); + _vertices->push_back(osg::Vec2f(256.0, 0.0)); + _vertices->push_back(osg::Vec2f(-256.0, -256.0)); + + _vertices->push_back(osg::Vec2f(256, 0.0)); + _vertices->push_back(osg::Vec2f(256.0, -256.0)); + _vertices->push_back(osg::Vec2f(-256.0, -256.0)); + + const osg::Vec2f whiteSpot(1.0f, 0.0f); + for (int i = 0; i < 3 * 4; i++) + _texCoords->push_back(whiteSpot); + + trimaskPSet->set(osg::PrimitiveSet::TRIANGLES, firstQuadVert, 3 * 4); + + } else + { + maskPSet->set(osg::PrimitiveSet::QUADS, 0, 0); + trimaskPSet->set(osg::PrimitiveSet::TRIANGLES, 0, 0); + } - } else { - maskPSet->set(osg::PrimitiveSet::QUADS, 0, 0); - trimaskPSet->set(osg::PrimitiveSet::TRIANGLES, 0, 0); + maskPSet->dirty(); + trimaskPSet->dirty(); } +#endif - maskPSet->dirty(); - trimaskPSet->dirty(); + // remember index of next vertex + int vIndex = _vertices->size(); - // draw without mask - _vertices->clear(); - _texCoords->clear(); + update_weather(); + + osg::DrawArrays *quadPSet + = static_cast(_geom->getPrimitiveSet(0)); update_aircraft(); update_tacan(); update_heading_marker(); - quadPSet->set(osg::PrimitiveSet::QUADS, 0, _vertices->size()); + // draw all new vertices are quads + quadPSet->set(osg::PrimitiveSet::QUADS, vIndex, _vertices->size()-vIndex); quadPSet->dirty(); } } @@ -466,14 +476,17 @@ wxRadarBg::update (double delta_time_sec) void wxRadarBg::update_weather() { - string modeButton = _Instrument->getStringValue("mode", "wx"); - _radarEchoBuffer = *sgEnviro.get_radar_echo(); + string modeButton = _Instrument->getStringValue("mode", "WX"); +// FIXME: implementation of radar echoes missing +// _radarEchoBuffer = *sgEnviro.get_radar_echo(); // pretend we have a scan angle bigger then the FOV // TODO:check real fov, enlarge if < nn, and do clipping if > mm - const float fovFactor = 1.45f; +// const float fovFactor = 1.45f; _Instrument->setStringValue("status", modeButton.c_str()); +// FIXME: implementation of radar echoes missing +#if 0 list_of_SGWxRadarEcho *radarEcho = &_radarEchoBuffer; list_of_SGWxRadarEcho::iterator iradarEcho, end = radarEcho->end(); const float LWClevel[] = { 0.1f, 0.5f, 2.1f }; @@ -499,14 +512,14 @@ wxRadarBg::update_weather() if (iradarEcho->lightning || lwc < LWClevel[level]) continue; - float radius = sgSqrt(iradarEcho->dist) * SG_METER_TO_NM * _scale; + float radius = sqrt(iradarEcho->dist) * SG_METER_TO_NM * _scale; float size = iradarEcho->radius * 2.0 * SG_METER_TO_NM * _scale; if (radius - size > 180) continue; float angle = (iradarEcho->heading - _angle_offset) //* fovFactor - + 0.5 * SG_PI; + + 0.5 * SG_PI; // Rotate echo into position, and rotate echo to have // a constant orientation towards the @@ -516,11 +529,11 @@ wxRadarBg::update_weather() const osg::Vec2f texBase(col, (UNIT * (float) (4 + (cloudId & 3)))); osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(angle) * _centerTrans); + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(angle) * _centerTrans); addQuad(_vertices, _texCoords, m, texBase); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: drawing clouds" + //SG_LOG(SG_INSTR, SG_DEBUG, "Radar: drawing clouds" // << " ID=" << cloudId // << " x=" << x // << " y="<< y @@ -544,20 +557,22 @@ wxRadarBg::update_weather() float size = UNIT * 0.5f; float radius = iradarEcho->dist * _scale; float angle = iradarEcho->heading * SG_DEGREES_TO_RADIANS - - _angle_offset; + - _angle_offset; osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * wxRotate(-angle) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(angle) * _centerTrans); + * wxRotate(-angle) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(angle) * _centerTrans); addQuad(_vertices, _texCoords, m, texBase); } } +#endif } void -wxRadarBg::update_data(FGAIBase *ac, double radius, double bearing, bool selected) +wxRadarBg::update_data(const SGPropertyNode *ac, double altitude, double heading, + double radius, double bearing, bool selected) { osgText::Text *callsign = new osgText::Text; callsign->setFont(_font.get()); @@ -565,8 +580,8 @@ wxRadarBg::update_data(FGAIBase *ac, double radius, double bearing, bool selecte callsign->setCharacterSize(_font_size); callsign->setColor(selected ? osg::Vec4(1, 1, 1, 1) : _font_color); osg::Matrixf m(wxRotate(-bearing) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(bearing) * _centerTrans); + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); osg::Vec3 pos = m.preMult(osg::Vec3(16, 16, 0)); // cast to int's, otherwise text comes out ugly @@ -574,12 +589,16 @@ wxRadarBg::update_data(FGAIBase *ac, double radius, double bearing, bool selecte callsign->setAlignment(osgText::Text::LEFT_BOTTOM_BASE_LINE); callsign->setLineSpacing(_font_spacing); + const char *identity = ac->getStringValue("transponder-id"); + if (!identity[0]) + identity = ac->getStringValue("callsign"); + stringstream text; - text << ac->_getCallsign() << endl - << setprecision(0) << fixed - << setw(3) << setfill('0') << ac->_getHeading() << "\xB0 " - << setw(0) << ac->_getAltitude() << "ft" << endl - << ac->_getSpeed() << "kts"; + text << identity << endl + << setprecision(0) << fixed + << setw(3) << setfill('0') << heading * SG_RADIANS_TO_DEGREES << "\xB0 " + << setw(0) << altitude << "ft" << endl + << ac->getDoubleValue("velocities/true-airspeed-kt") << "kts"; callsign->setText(text.str()); _textGeode->addDrawable(callsign); @@ -589,23 +608,86 @@ wxRadarBg::update_data(FGAIBase *ac, double radius, double bearing, bool selecte void wxRadarBg::update_aircraft() { + double diff; + double age_factor = 1.0; + double test_rng; + double test_brg; + double range; + double bearing; + float echo_radius; + double angle; + + if (!ground_echoes.empty()){ + ground_echoes_iterator = ground_echoes.begin(); + + while(ground_echoes_iterator != ground_echoes.end()) { + diff = _elapsed_time - (*ground_echoes_iterator)->elapsed_time; + + if( diff > _persistance) { + ground_echoes.erase(ground_echoes_iterator++); + } else { +// double test_brg = (*ground_echoes_iterator)->bearing; +// double bearing = test_brg * SG_DEGREES_TO_RADIANS; +// float angle = calcRelBearing(bearing, _view_heading); + double bumpinessFactor = (*ground_echoes_iterator)->bumpiness; + float heading = fgGetDouble("/orientation/heading-deg"); + if ( _display_mode == BSCAN ){ + test_rng = (*ground_echoes_iterator)->elevation * 6; + test_brg = (*ground_echoes_iterator)->bearing; + angle = calcRelBearingDeg(test_brg, heading) * 6; + range = sqrt(test_rng * test_rng + angle * angle); + bearing = atan2(angle, test_rng); + //cout << "angle " << angle <<" bearing " + // << bearing / SG_DEGREES_TO_RADIANS << endl; + echo_radius = (0.1 + (1.9 * bumpinessFactor)) * 240 * age_factor; + } else { + test_rng = (*ground_echoes_iterator)->range; + range = test_rng * SG_METER_TO_NM; + test_brg = (*ground_echoes_iterator)->bearing; + bearing = test_brg * SG_DEGREES_TO_RADIANS; + echo_radius = (0.1 + (1.9 * bumpinessFactor)) * 120 * age_factor; + bearing += _angle_offset; + } + + float radius = range * _scale; + //double heading = 90 * SG_DEGREES_TO_RADIANS; + //heading += _angle_offset; + + age_factor = 1; + + if (diff != 0) + age_factor = 1 - (0.5 * diff/_persistance); + + float size = echo_radius * UNIT; + + const osg::Vec2f texBase(3 * UNIT, 3 * UNIT); + osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); + addQuad(_vertices, _texCoords, m, texBase); + + ++ground_echoes_iterator; + + //cout << "test bearing " << test_brg + //<< " test_rng " << test_rng * SG_METER_TO_NM + //<< " persistance " << _persistance + //<< endl; + } + + } + + } if (!_ai_enabled_node->getBoolValue()) return; - bool draw_echoes = _radar_position_node->getBoolValue(); - bool draw_symbols = _radar_symbol_node->getBoolValue(); - bool draw_data = _radar_data_node->getBoolValue(); + bool draw_tcas = _radar_tcas_node->getBoolValue(); + bool draw_absolute = _radar_absalt_node->getBoolValue(); + bool draw_echoes = _radar_position_node->getBoolValue(); + bool draw_symbols = _radar_symbol_node->getBoolValue(); + bool draw_data = _radar_data_node->getBoolValue(); if (!draw_echoes && !draw_symbols && !draw_data) return; - radar_list_type radar_list = _ai->get_ai_list(); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: AI submodel list size" << radar_list.size()); - if (radar_list.empty()) - return; - - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: Loading AI submodels "); - const double echo_radii[] = {0, 1, 1.5, 1.5, 0.001, 0.1, 1.5, 2, 1.5, 1.5, 1.5}; - double user_lat = _user_lat_node->getDoubleValue(); double user_lon = _user_lon_node->getDoubleValue(); double user_alt = _user_alt_node->getDoubleValue(); @@ -617,39 +699,62 @@ wxRadarBg::update_aircraft() limit = 0; limit *= SG_DEGREES_TO_RADIANS; - radar_list_iterator it = radar_list.begin(); - radar_list_iterator end = radar_list.end(); - FGAIBase *selected_ac = 0; - double selected_radius = 0; - double selected_bearing = 0; int selected_id = fgGetInt("/instrumentation/radar/selected-id", -1); - for (; it != end; ++it) { - FGAIBase *ac = (*it).get(); - int type = ac->getType(); - double lat = ac->_getLatitude(); - double lon = ac->_getLongitude(); - double alt = ac->_getAltitude(); - double heading = ac->_getHeading(); + const SGPropertyNode *selected_ac = 0; + const SGPropertyNode *ai = fgGetNode("/ai/models", true); - double range, bearing; - calcRangeBearing(user_lat, user_lon, lat, lon, range, bearing); + for (int i = ai->nChildren() - 1; i >= -1; i--) { + const SGPropertyNode *model; - //SG_LOG(SG_GENERAL, SG_DEBUG, - /* "Radar: ID=" << ac->getID() << "(" << radar_list.size() << ")" - << " type=" << type - << " view_heading=" << _view_heading * SG_RADIANS_TO_DEGREES - << " alt=" << alt - << " heading=" << heading - << " range=" << range - << " bearing=" << bearing);*/ + if (i < 0) { // last iteration: selected model + model = selected_ac; + } else { + model = ai->getChild(i); + if (!model->nChildren()) + continue; + if ((model->getIntValue("id") == selected_id)&& + (!draw_tcas)) { + selected_ac = model; // save selected model for last iteration + continue; + } + } + if (!model) + continue; + + double echo_radius, sigma; + const string name = model->getName(); + + //cout << "name "<getDoubleValue("position/latitude-deg"); + double lon = model->getDoubleValue("position/longitude-deg"); + double alt = model->getDoubleValue("position/altitude-ft"); + double heading = model->getDoubleValue("orientation/true-heading-deg"); + + double range, bearing; + calcRangeBearing(user_lat, user_lon, lat, lon, range, bearing); + //cout << _antenna_ht << _interval<< endl; bool isVisible = withinRadarHorizon(user_alt, alt, range); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: visible " << isVisible); + if (!isVisible) continue; - if (!inRadarRange(type, range)) + if (!inRadarRange(sigma, range)) continue; bearing *= SG_DEGREES_TO_RADIANS; @@ -664,55 +769,126 @@ wxRadarBg::update_aircraft() bearing += _angle_offset; heading += _angle_offset; + bool is_tcas_contact = false; + if (draw_tcas) + { + is_tcas_contact = update_tcas(model,range,user_alt,alt,bearing,radius,draw_absolute); + } + // pos mode - if (draw_echoes) { - float echo_radius = echo_radii[type] * 120; - float size = echo_radius * UNIT; + if (draw_echoes && (!is_tcas_contact)) { + float size = echo_radius * 120 * UNIT; const osg::Vec2f texBase(3 * UNIT, 3 * UNIT); osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(bearing) * _centerTrans); + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); addQuad(_vertices, _texCoords, m, texBase); - - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: drawing AI" - //<< " ID=" << ac->getID() - //<< " type=" << type - // << " radius=" << radius - // << " angle=" << angle * SG_RADIANS_TO_DEGREES); } // data mode - if (draw_symbols) { + if (draw_symbols && (!draw_tcas)) { const osg::Vec2f texBase(0, 3 * UNIT); float size = 600 * UNIT; osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * wxRotate(heading - bearing) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(bearing) * _centerTrans); + * wxRotate(heading - bearing) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); addQuad(_vertices, _texCoords, m, texBase); - - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: drawing data" - // << " x=" << x <<" y="<< y - // << " bearing=" << angle * SG_RADIANS_TO_DEGREES - // << " radius=" << radius); } - if (draw_data) { - if (ac->getID() == selected_id) { - selected_ac = ac; - selected_radius = radius; - selected_bearing = bearing; - } else { - update_data(ac, radius, bearing, false); - } + if ((draw_data || i < 0)&& // selected one (i == -1) is always drawn + ((!draw_tcas)||(is_tcas_contact)||(draw_echoes))) + update_data(model, alt, heading, radius, bearing, i < 0); + } +} + +/** Update TCAS display. + * Return true when processed as TCAS contact, false otherwise. */ +bool +wxRadarBg::update_tcas(const SGPropertyNode *model,double range,double user_alt,double alt, + double bearing,double radius,bool absMode) +{ + int threatLevel=0; + { + // update TCAS symbol + osg::Vec2f texBase; + threatLevel = model->getIntValue("tcas/threat-level",-1); + if (threatLevel == -1) + { + // no TCAS information (i.e. no transponder) => not visible to TCAS + return false; } + int row = 7 - threatLevel; + int col = 4; + double vspeed = model->getDoubleValue("velocities/vertical-speed-fps"); + if (vspeed < -3.0) // descending + col+=1; + else + if (vspeed > 3.0) // climbing + col+=2; + texBase = osg::Vec2f(col*UNIT,row * UNIT); + float size = 200 * UNIT; + osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) + * wxRotate(-bearing) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); + addQuad(_vertices, _texCoords, m, texBase); } - if (selected_ac) { - update_data(selected_ac, selected_radius, selected_bearing, true); + + { + // update TCAS data + osgText::Text *altStr = new osgText::Text; + altStr->setFont(_font.get()); + altStr->setFontResolution(12, 12); + altStr->setCharacterSize(_font_size); + altStr->setColor(_tcas_colors[threatLevel]); + osg::Matrixf m(wxRotate(-bearing) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(bearing) * _centerTrans); + + osg::Vec3 pos = m.preMult(osg::Vec3(16, 16, 0)); + // cast to int's, otherwise text comes out ugly + altStr->setLineSpacing(_font_spacing); + + stringstream text; + altStr->setAlignment(osgText::Text::LEFT_CENTER); + int altDif = (alt-user_alt+50)/100; + char sign = 0; + int dy=0; + if (altDif>=0) + { + sign='+'; + dy=2; + } + else + if (altDif<0) + { + sign='-'; + altDif = -altDif; + dy=-30; + } + altStr->setPosition(osg::Vec3((int)pos.x()-30, (int)pos.y()+dy, 0)); + if (absMode) + { + // absolute altitude display + text << setprecision(0) << fixed + << setw(3) << setfill('0') << alt/100 << endl; + } + else // relative altitude display + if (sign) + { + text << sign + << setprecision(0) << fixed + << setw(2) << setfill('0') << altDif << endl; + } + + altStr->setText(text.str()); + _textGeode->addDrawable(altStr); } -} + return true; +} void wxRadarBg::update_tacan() @@ -727,16 +903,16 @@ wxRadarBg::update_tacan() float size = 600 * UNIT; float radius = _tacan_distance_node->getFloatValue() * _scale; float angle = _tacan_bearing_node->getFloatValue() * SG_DEGREES_TO_RADIANS - + _angle_offset; + + _angle_offset; const osg::Vec2f texBase(1 * UNIT, 3 * UNIT); osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * wxRotate(-angle) - * osg::Matrixf::translate(0.0f, radius, 0.0f) - * wxRotate(angle) * _centerTrans); + * wxRotate(-angle) + * osg::Matrixf::translate(0.0f, radius, 0.0f) + * wxRotate(angle) * _centerTrans); addQuad(_vertices, _texCoords, m, texBase); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: drawing TACAN" + //SG_LOG(SG_INSTR, SG_DEBUG, "Radar: drawing TACAN" // << " dist=" << radius // << " view_heading=" << _view_heading * SG_RADIANS_TO_DEGREES // << " bearing=" << angle * SG_RADIANS_TO_DEGREES @@ -754,12 +930,12 @@ wxRadarBg::update_heading_marker() const osg::Vec2f texBase(2 * UNIT, 3 * UNIT); float size = 600 * UNIT; osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f) - * wxRotate(_view_heading + _angle_offset)); + * wxRotate(_view_heading + _angle_offset)); m *= _centerTrans; addQuad(_vertices, _texCoords, m, texBase); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: drawing heading marker" + //SG_LOG(SG_INSTR, SG_DEBUG, "Radar: drawing heading marker" // << " x,y " << x <<","<< y // << " dist" << dist // << " view_heading" << _view_heading * SG_RADIANS_TO_DEGREES @@ -798,21 +974,23 @@ wxRadarBg::withinRadarHorizon(double user_alt, double alt, double range_nm) { // Radar Horizon = 1.23(ht^1/2 + hr^1/2), //don't allow negative altitudes (an approximation - yes altitudes can be negative) + // Allow antenna ht to be set, but only on ground + _antenna_ht = _Instrument->getDoubleValue("antenna-ht-ft"); - if (user_alt < 0) - user_alt = 0; + if (user_alt <= 0) + user_alt = _antenna_ht; - if (alt < 0) - alt = 0; + if (alt <= 0) + alt = 0; // to allow some vertical extent of target double radarhorizon = 1.23 * (sqrt(alt) + sqrt(user_alt)); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: horizon " << radarhorizon); +// SG_LOG(SG_INSTR, SG_ALERT, "Radar: radar horizon " << radarhorizon); return radarhorizon >= range_nm; } bool -wxRadarBg::inRadarRange(int type, double range_nm) +wxRadarBg::inRadarRange(double sigma, double range_nm) { //The Radar Equation: // @@ -828,21 +1006,20 @@ wxRadarBg::inRadarRange(int type, double range_nm) // // TODO - make the maximum range adjustable at runtime - const double sigma[] = {0, 1, 100, 100, 0.001, 0.1, 100, 100, 1, 1, 1}; double constant = _radar_ref_rng; if (constant <= 0) constant = 35; - double maxrange = constant * pow(sigma[type], 0.25); - //SG_LOG(SG_GENERAL, SG_DEBUG, "Radar: max range " << maxrange); + double maxrange = constant * pow(sigma, 0.25); + //SG_LOG(SG_INSTR, SG_DEBUG, "Radar: max range " << maxrange); return maxrange >= range_nm; } void wxRadarBg::calcRangeBearing(double lat, double lon, double lat2, double lon2, - double &range, double &bearing) const + double &range, double &bearing) const { // calculate the bearing and range of the second pos from the first double az2, distance; @@ -865,6 +1042,20 @@ wxRadarBg::calcRelBearing(float bearing, float heading) return angle; } +float +wxRadarBg::calcRelBearingDeg(float bearing, float heading) +{ + float angle = bearing - heading; + + if (angle >= 180) + return angle -= 360; + + if (angle < -180) + return angle += 360; + + return angle; +} + void wxRadarBg::updateFont() @@ -902,11 +1093,23 @@ wxRadarBg::updateFont() _font->setGlyphImageMargin(0); _font->setGlyphImageMarginRatio(0); } + + for (int i=0;i<4;i++) + { + const float defaultColors[4][3] = {{0,1,1},{0,1,1},{1,0.5,0},{1,0,0}}; + SGPropertyNode_ptr color_node = _font_node->getNode("tcas/color",i,true); + float red = color_node->getFloatValue("red",defaultColors[i][0]); + float green = color_node->getFloatValue("green",defaultColors[i][1]); + float blue = color_node->getFloatValue("blue",defaultColors[i][2]); + float alpha = color_node->getFloatValue("alpha",1); + _tcas_colors[i]=osg::Vec4(red, green, blue, alpha); + } } void wxRadarBg::valueChanged(SGPropertyNode*) { updateFont(); + _time = _interval; }