#include "NavDisplay.hxx"
+#include <cassert>
+#include <boost/foreach.hpp>
+#include <boost/algorithm/string/case_conv.hpp>
+#include <algorithm>
+
#include <osg/Array>
#include <osg/Geometry>
#include <osg/Matrixf>
#include <osg/PrimitiveSet>
#include <osg/StateSet>
#include <osg/LineWidth>
-
#include <osg/Version>
-#include <osgDB/ReaderWriter>
-#include <osgDB/WriteFile>
#include <simgear/constants.h>
#include <simgear/misc/sg_path.hxx>
#include <simgear/scene/model/model.hxx>
#include <simgear/structure/exception.hxx>
#include <simgear/misc/sg_path.hxx>
+#include <simgear/misc/strutils.hxx>
#include <simgear/math/sg_geodesy.hxx>
#include <sstream>
using std::setfill;
using std::cout;
using std::endl;
+using std::map;
+using std::string;
#include <Main/fg_props.hxx>
#include <Main/globals.hxx>
#include "instrument_mgr.hxx"
#include "od_gauge.hxx"
-static const float UNIT = 1.0f / 8.0f; // 8 symbols in a row/column in the texture
static const char *DEFAULT_FONT = "typewriter.txf";
+static
+osg::Matrixf degRotation(float angle)
+{
+ return osg::Matrixf::rotate(angle * SG_DEGREES_TO_RADIANS, 0.0f, 0.0f, -1.0f);
+}
+
+static osg::Vec4 readColor(SGPropertyNode* colorNode, const osg::Vec4& c)
+{
+ osg::Vec4 result;
+ result.r() = colorNode->getDoubleValue("red", c.r());
+ result.g() = colorNode->getDoubleValue("green", c.g());
+ result.b() = colorNode->getDoubleValue("blue", c.b());
+ result.a() = colorNode->getDoubleValue("alpha", c.a());
+ return result;
+}
+
+static osgText::Text::AlignmentType readAlignment(const std::string& t)
+{
+ if (t == "left-top") {
+ return osgText::Text::LEFT_TOP;
+ } else if (t == "left-center") {
+ return osgText::Text::LEFT_CENTER;
+ } else if (t == "left-bottom") {
+ return osgText::Text::LEFT_BOTTOM;
+ } else if (t == "center-top") {
+ return osgText::Text::CENTER_TOP;
+ } else if (t == "center-center") {
+ return osgText::Text::CENTER_CENTER;
+ } else if (t == "center-bottom") {
+ return osgText::Text::CENTER_BOTTOM;
+ } else if (t == "right-top") {
+ return osgText::Text::RIGHT_TOP;
+ } else if (t == "right-center") {
+ return osgText::Text::RIGHT_CENTER;
+ } else if (t == "right-bottom") {
+ return osgText::Text::RIGHT_BOTTOM;
+ } else if (t == "left-baseline") {
+ return osgText::Text::LEFT_BASE_LINE;
+ } else if (t == "center-baseline") {
+ return osgText::Text::CENTER_BASE_LINE;
+ } else if (t == "right-baseline") {
+ return osgText::Text::RIGHT_BASE_LINE;
+ }
+
+ return osgText::Text::BASE_LINE;
+}
+
+static string formatPropertyValue(SGPropertyNode* nd, const string& format)
+{
+ assert(nd);
+ static char buf[512];
+ if (format.find('d') != string::npos) {
+ ::snprintf(buf, 512, format.c_str(), nd->getIntValue());
+ return buf;
+ }
+
+ if (format.find('s') != string::npos) {
+ ::snprintf(buf, 512, format.c_str(), nd->getStringValue());
+ return buf;
+ }
+
+// assume it's a double/float
+ ::snprintf(buf, 512, format.c_str(), nd->getDoubleValue());
+ return buf;
+}
+
+static osg::Vec2 mult(const osg::Vec2& v, const osg::Matrixf& m)
+{
+ osg::Vec3 r = m.preMult(osg::Vec3(v.x(), v.y(), 0.0));
+ return osg::Vec2(r.x(), r.y());
+}
+
+class NavDisplay::CacheListener : public SGPropertyChangeListener
+{
+public:
+ CacheListener(NavDisplay *nd) :
+ _nd(nd)
+ {}
+
+ virtual void valueChanged (SGPropertyNode * prop)
+ {
+ _nd->invalidatePositionedCache();
+ }
+private:
+ NavDisplay* _nd;
+};
+
+class NavDisplay::ForceUpdateListener : public SGPropertyChangeListener
+{
+public:
+ ForceUpdateListener(NavDisplay *nd) :
+ _nd(nd)
+ {}
+
+ virtual void valueChanged (SGPropertyNode * prop)
+ {
+ _nd->forceUpdate();
+ }
+private:
+ NavDisplay* _nd;
+};
+
+///////////////////////////////////////////////////////////////////
+
+class SymbolRule
+{
+public:
+ SymbolRule()
+ {
+
+ }
+
+ bool initFromNode(SGPropertyNode* node, NavDisplay* owner)
+ {
+ if (!node->getChild("type")) {
+ return false;
+ }
+
+ type = node->getStringValue("type");
+ boost::to_lower(type);
+ SGPropertyNode* enableNode = node->getChild("enable");
+ if (enableNode) {
+ enable.reset(sgReadCondition(fgGetNode("/"), enableNode));
+ }
+
+ int n=0;
+ while (node->hasChild("state", n)) {
+ string m = node->getChild("state", n++)->getStringValue();
+ if (m[0] == '!') {
+ excluded_states.insert(m.substr(1));
+ } else {
+ required_states.insert(m);
+ }
+ } // of matches parsing
+
+
+ return true;
+ }
+
+ void setDefinition(SymbolDef* d)
+ {
+ definition = d;
+ }
+
+ SymbolDef* getDefinition() const
+ { return definition; }
+
+ bool matches(const string_set& states) const
+ {
+ BOOST_FOREACH(const string& s, required_states) {
+ if (states.count(s) == 0) {
+ return false;
+ }
+ }
+
+ BOOST_FOREACH(const string& s, excluded_states) {
+ if (states.count(s) != 0) {
+ return false;
+ }
+ }
+
+ return true;
+ }
+
+ // return if the enabled state changed (needs a cache update)
+ bool checkEnabled()
+ {
+ if (enable.get()) {
+ bool wasEnabled = enabled;
+ enabled = enable->test();
+ return (enabled != wasEnabled);
+ } else {
+ enabled = true;
+ return false;
+ }
+ }
+
+ bool enabled; // cached enabled state
+ std::string type;
+
+ // record instances for limiting by count
+ int instanceCount;
+private:
+ SymbolDef* definition;
+
+ std::auto_ptr<SGCondition> enable;
+ string_set required_states;
+ string_set excluded_states;
+};
+
+class SymbolDef
+{
+public:
+ SymbolDef() : limitCount(0) { }
+
+ bool initFromNode(SGPropertyNode* node, NavDisplay* owner)
+ {
+ if (node->getChild("type")) {
+ SymbolRule* builtinRule = new SymbolRule;
+ builtinRule->initFromNode(node, owner);
+ builtinRule->setDefinition(this);
+ owner->addRule(builtinRule);
+ }
+
+ if (node->hasChild("width")) {
+ float w = node->getFloatValue("width");
+ float h = node->getFloatValue("height", w);
+ xy0.x() = -w * 0.5;
+ xy0.y() = -h * 0.5;
+ xy1.x() = w * 0.5;
+ xy1.y() = h * 0.5;
+ } else {
+ xy0.x() = node->getFloatValue("x0", 0.0);
+ xy0.y() = node->getFloatValue("y0", 0.0);
+ xy1.x() = node->getFloatValue("x1", 5);
+ xy1.y() = node->getFloatValue("y1", 5);
+ }
+
+ double texSize = node->getFloatValue("texture-size", owner->textureSize());
+
+ uv0.x() = node->getFloatValue("u0", 0) / texSize;
+ uv0.y() = node->getFloatValue("v0", 0) / texSize;
+ uv1.x() = node->getFloatValue("u1", 1) / texSize;
+ uv1.y() = node->getFloatValue("v1", 1) / texSize;
+
+ color = readColor(node->getChild("color"), osg::Vec4(1, 1, 1, 1));
+ priority = node->getIntValue("priority", 0);
+ zOrder = node->getIntValue("zOrder", 0);
+ rotateToHeading = node->getBoolValue("rotate-to-heading", false);
+ roundPos = node->getBoolValue("round-position", true);
+ hasText = false;
+ if (node->hasChild("text")) {
+ hasText = true;
+ alignment = readAlignment(node->getStringValue("text-align"));
+ textTemplate = node->getStringValue("text");
+ textOffset.x() = node->getFloatValue("text-offset-x", 0);
+ textOffset.y() = node->getFloatValue("text-offset-y", 0);
+ textColor = readColor(node->getChild("text-color"), color);
+
+ SGPropertyNode* enableNode = node->getChild("text-enable");
+ if (enableNode) {
+ textEnable.reset(sgReadCondition(fgGetNode("/"), enableNode));
+ }
+ }
+
+ drawLine = node->getBoolValue("draw-line", false);
+ lineColor = readColor(node->getChild("line-color"), color);
+ drawRouteLeg = node->getBoolValue("draw-leg", false);
+
+ stretchSymbol = node->getBoolValue("stretch-symbol", false);
+ if (stretchSymbol) {
+ stretchY2 = node->getFloatValue("y2");
+ stretchY3 = node->getFloatValue("y3");
+ stretchV2 = node->getFloatValue("v2") / texSize;
+ stretchV3 = node->getFloatValue("v3") / texSize;
+ }
+
+ SGPropertyNode* limitNode = node->getChild("limit");
+ if (limitNode) {
+ limitCount = limitNode->getIntValue();
+ }
+
+ return true;
+ }
+
+ osg::Vec2 xy0, xy1;
+ osg::Vec2 uv0, uv1;
+ osg::Vec4 color;
+
+ int priority;
+ int zOrder;
+ bool rotateToHeading;
+ bool roundPos; ///< should position be rounded to integer values
+ bool hasText;
+ std::auto_ptr<SGCondition> textEnable;
+ bool textEnabled; ///< cache condition result
+ osg::Vec4 textColor;
+ osg::Vec2 textOffset;
+ osgText::Text::AlignmentType alignment;
+ string textTemplate;
+
+ bool drawLine;
+ osg::Vec4 lineColor;
+
+// symbol stretching creates three quads (instead of one) - a start,
+// middle and end quad, positioned along the line of the symbol.
+// X (and U) axis values determined by the values above, so we only need
+// to define the Y (and V) values to build the other quads.
+ bool stretchSymbol;
+ double stretchY2, stretchY3;
+ double stretchV2, stretchV3;
+
+ bool drawRouteLeg;
+
+ int limitCount, instanceCount;
+};
+
+class SymbolInstance
+{
+public:
+ SymbolInstance(const osg::Vec2& p, double h, SymbolDef* def, SGPropertyNode* vars) :
+ pos(p),
+ headingDeg(h),
+ definition(def),
+ props(vars)
+ { }
+
+ osg::Vec2 pos; // projected position
+ osg::Vec2 endPos;
+ double headingDeg;
+ SymbolDef* definition;
+ SGPropertyNode_ptr props;
+
+ string text() const
+ {
+ assert(definition->hasText);
+ string r;
+ size_t lastPos = 0;
+
+ while (true) {
+ size_t pos = definition->textTemplate.find('{', lastPos);
+ if (pos == string::npos) { // no more replacements
+ r.append(definition->textTemplate.substr(lastPos));
+ break;
+ }
+
+ r.append(definition->textTemplate.substr(lastPos, pos - lastPos));
+
+ size_t endReplacement = definition->textTemplate.find('}', pos+1);
+ if (endReplacement <= pos) {
+ return "bad replacement";
+ }
+
+ string spec = definition->textTemplate.substr(pos + 1, endReplacement - (pos + 1));
+ // look for formatter in spec
+ size_t colonPos = spec.find(':');
+ if (colonPos == string::npos) {
+ // simple replacement
+ r.append(props->getStringValue(spec));
+ } else {
+ string format = spec.substr(colonPos + 1);
+ string prop = spec.substr(0, colonPos);
+ r.append(formatPropertyValue(props->getNode(prop), format));
+ }
+
+ lastPos = endReplacement + 1;
+ }
+
+ return r;
+ }
+};
+
+//////////////////////////////////////////////////////////////////
+
NavDisplay::NavDisplay(SGPropertyNode *node) :
_name(node->getStringValue("name", "nd")),
_num(node->getIntValue("number", 0)),
_time(0.0),
- _interval(node->getDoubleValue("update-interval-sec", 1.0)),
- _elapsed_time(0),
- _persistance(0),
- _sim_init_done(false),
+ _updateInterval(node->getDoubleValue("update-interval-sec", 0.1)),
+ _forceUpdate(true),
_odg(0),
_scale(0),
- _angle_offset(0),
_view_heading(0),
- _x_offset(0),
- _y_offset(0),
- _radar_ref_rng(0),
- _lat(0),
- _lon(0),
- _resultTexture(0),
_font_size(0),
_font_spacing(0),
- _rangeNm(0)
+ _rangeNm(0),
+ _maxSymbols(100)
{
_Instrument = fgGetNode(string("/instrumentation/" + _name).c_str(), _num, true);
_font_node = _Instrument->getNode("font", true);
INITFONT("color/alpha", 1, Float);
#undef INITFONT
+ _textureSize = _Instrument->getNode("symbol-texture-size", true)->getIntValue();
+ SGPropertyNode* symbolsNode = node->getNode("symbols");
+ SGPropertyNode* symbol;
+
+ map<string, SymbolDef*> definitionDict;
+ for (int i = 0; (symbol = symbolsNode->getChild("symbol", i)) != NULL; ++i) {
+ SymbolDef* def = new SymbolDef;
+ if (!def->initFromNode(symbol, this)) {
+ delete def;
+ continue;
+ }
+
+ const char* id = symbol->getStringValue("id");
+ if (id && strlen(id)) {
+ definitionDict[id] = def;
+ }
+
+ _definitions.push_back(def);
+ } // of symbol definition parsing
+
+ SGPropertyNode* rulesNode = node->getNode("rules");
+ if (rulesNode) {
+ SGPropertyNode* rule;
+
+ for (int i = 0; (rule = rulesNode->getChild("rule", i)) != NULL; ++i) {
+ SymbolRule* r = new SymbolRule;
+ if (!r->initFromNode(rule, this)) {
+ delete r;
+ continue;
+ }
+
+ const char* id = symbol->getStringValue("symbol");
+ if (id && strlen(id) && (definitionDict.find(id) != definitionDict.end())) {
+ r->setDefinition(definitionDict[id]);
+ } else {
+ SG_LOG(SG_INSTR, SG_WARN, "symbol rule has missing/unknown definition id:" << id);
+ delete r;
+ continue;
+ }
+
+ addRule(r);
+ } // of symbol rule parsing
+ }
+
}
NavDisplay::~NavDisplay()
{
+ delete _odg;
}
-
void
NavDisplay::init ()
{
+ _cachedItemsValid = false;
+ _cacheListener.reset(new CacheListener(this));
+ _forceUpdateListener.reset(new ForceUpdateListener(this));
+
_serviceable_node = _Instrument->getNode("serviceable", true);
-
+ _rangeNode = _Instrument->getNode("range", true);
+ if (!_rangeNode->hasValue()) {
+ _rangeNode->setDoubleValue(40.0);
+ }
+ _rangeNode->addChangeListener(_cacheListener.get());
+ _rangeNode->addChangeListener(_forceUpdateListener.get());
+
+ _xCenterNode = _Instrument->getNode("x-center");
+ if (!_xCenterNode->hasValue()) {
+ _xCenterNode->setDoubleValue(0.5);
+ }
+ _xCenterNode->addChangeListener(_forceUpdateListener.get());
+ _yCenterNode = _Instrument->getNode("y-center");
+ if (!_yCenterNode->hasValue()) {
+ _yCenterNode->setDoubleValue(0.5);
+ }
+ _yCenterNode->addChangeListener(_forceUpdateListener.get());
+
// texture name to use in 2D and 3D instruments
_texture_path = _Instrument->getStringValue("radar-texture-path",
"Aircraft/Instruments/Textures/od_wxradar.rgb");
- _resultTexture = FGTextureManager::createTexture(_texture_path.c_str(), false);
string path = _Instrument->getStringValue("symbol-texture-path",
"Aircraft/Instruments/Textures/nd-symbols.png");
SGPath tpath = globals->resolve_aircraft_path(path);
-
+ if (!tpath.exists()) {
+ SG_LOG(SG_INSTR, SG_WARN, "ND symbol texture not found:" << path);
+ }
+
// no mipmap or else alpha will mix with pixels on the border of shapes, ruining the effect
- _symbols = SGLoadTexture2D(tpath, NULL, false, false);
+ _symbolTexture = SGLoadTexture2D(tpath, NULL, false, false);
- FGInstrumentMgr *imgr = (FGInstrumentMgr *)globals->get_subsystem("instrumentation");
- _odg = (FGODGauge *)imgr->get_subsystem("od_gauge");
+ _odg = new FGODGauge;
_odg->setSize(_Instrument->getIntValue("texture-size", 512));
-
- _user_lat_node = fgGetNode("/position/latitude-deg", true);
- _user_lon_node = fgGetNode("/position/longitude-deg", true);
- _user_alt_node = fgGetNode("/position/altitude-ft", true);
-
- SGPropertyNode *n = _Instrument->getNode("display-controls", true);
- _radar_weather_node = n->getNode("WX", true);
- _radar_position_node = n->getNode("pos", true);
- _radar_data_node = n->getNode("data", true);
- _radar_symbol_node = n->getNode("symbol", true);
- _radar_centre_node = n->getNode("centre", true);
- _radar_tcas_node = n->getNode("tcas", true);
- _radar_absalt_node = n->getNode("abs-altitude", true);
-
- _ai_enabled_node = fgGetNode("/sim/ai/enabled", true);
_route = static_cast<FGRouteMgr*>(globals->get_subsystem("route-manager"));
+ _navRadio1Node = fgGetNode("/instrumentation/nav[0]", true);
+ _navRadio2Node = fgGetNode("/instrumentation/nav[1]", true);
+
+ _excessDataNode = _Instrument->getChild("excess-data", 0, true);
+ _excessDataNode->setBoolValue(false);
+ _testModeNode = _Instrument->getChild("test-mode", 0, true);
+ _testModeNode->setBoolValue(false);
+
+ _viewHeadingNode = _Instrument->getChild("view-heading-deg", 0, true);
// OSG geometry setup
_radarGeode = new osg::Geode;
- osg::StateSet *stateSet = _radarGeode->getOrCreateStateSet();
- stateSet->setTextureAttributeAndModes(0, _symbols.get());
-
- osg::LineWidth *lw = new osg::LineWidth();
- lw->setWidth(2.0);
- stateSet->setAttribute(lw);
-
+
_geom = new osg::Geometry;
_geom->setUseDisplayList(false);
+
+ osg::StateSet *stateSet = _geom->getOrCreateStateSet();
+ stateSet->setTextureAttributeAndModes(0, _symbolTexture.get());
+ stateSet->setDataVariance(osg::Object::STATIC);
+
// Initially allocate space for 128 quads
_vertices = new osg::Vec2Array;
_vertices->setDataVariance(osg::Object::DYNAMIC);
_texCoords->reserve(128 * 4);
_geom->setTexCoordArray(0, _texCoords);
- osg::Vec3Array *colors = new osg::Vec3Array;
- colors->push_back(osg::Vec3(1.0f, 1.0f, 1.0f)); // color of echos
- _geom->setColorBinding(osg::Geometry::BIND_PER_PRIMITIVE_SET);
- _geom->setColorArray(colors);
+ _quadColors = new osg::Vec4Array;
+ _quadColors->setDataVariance(osg::Object::DYNAMIC);
+ _geom->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
+ _geom->setColorArray(_quadColors);
_symbolPrimSet = new osg::DrawArrays(osg::PrimitiveSet::QUADS);
_symbolPrimSet->setDataVariance(osg::Object::DYNAMIC);
_geom->setInitialBound(osg::BoundingBox(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
_lineGeometry = new osg::Geometry;
_lineGeometry->setUseDisplayList(false);
+ stateSet = _lineGeometry->getOrCreateStateSet();
+ osg::LineWidth *lw = new osg::LineWidth();
+ lw->setWidth(2.0);
+ stateSet->setAttribute(lw);
_lineVertices = new osg::Vec2Array;
_lineVertices->setDataVariance(osg::Object::DYNAMIC);
_lineVertices->reserve(128 * 4);
- _lineGeometry->setVertexArray(_vertices);
+ _lineGeometry->setVertexArray(_lineVertices);
- _lineColors = new osg::Vec3Array;
+ _lineColors = new osg::Vec4Array;
_lineColors->setDataVariance(osg::Object::DYNAMIC);
_lineGeometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
- _lineGeometry->setColorArray(colors);
+ _lineGeometry->setColorArray(_lineColors);
_linePrimSet = new osg::DrawArrays(osg::PrimitiveSet::LINES);
_linePrimSet->setDataVariance(osg::Object::DYNAMIC);
osg::Camera *camera = _odg->getCamera();
camera->addChild(_radarGeode.get());
camera->addChild(_textGeode.get());
-
+ osg::Texture2D* tex = _odg->getTexture();
+ camera->setProjectionMatrixAsOrtho2D(0, tex->getTextureWidth(),
+ 0, tex->getTextureHeight());
+
updateFont();
}
-
-// Local coordinates for each echo
-const osg::Vec3f symbolCoords[4] = {
- osg::Vec3f(-.7f, -.7f, 0.0f), osg::Vec3f(.7f, -.7f, 0.0f),
- osg::Vec3f(.7f, .7f, 0.0f), osg::Vec3f(-.7f, .7f, 0.0f)
-};
-
-
-const osg::Vec2f symbolTexCoords[4] = {
- osg::Vec2f(0.0f, 0.0f), osg::Vec2f(UNIT, 0.0f),
- osg::Vec2f(UNIT, UNIT), osg::Vec2f(0.0f, UNIT)
-};
-
-
-// helper
-static void
-addQuad(osg::Vec2Array *vertices, osg::Vec2Array *texCoords,
- const osg::Matrixf& transform, const osg::Vec2f& texBase)
-{
- for (int i = 0; i < 4; i++) {
- const osg::Vec3f coords = transform.preMult(symbolCoords[i]);
- texCoords->push_back(texBase + symbolTexCoords[i]);
- vertices->push_back(osg::Vec2f(coords.x(), coords.y()));
- }
-}
-
-
-// Rotate by a heading value
-static inline
-osg::Matrixf wxRotate(float angle)
-{
- return osg::Matrixf::rotate(angle, 0.0f, 0.0f, -1.0f);
-}
-
-
void
NavDisplay::update (double delta_time_sec)
{
return;
}
- _time += delta_time_sec;
- if (_time < _interval){
- return;
+ if (_forceUpdate) {
+ _forceUpdate = false;
+ _time = 0.0;
+ } else {
+ _time += delta_time_sec;
+ if (_time < _updateInterval){
+ return;
+ }
+ _time -= _updateInterval;
}
- _time -= _interval;
- string mode = _Instrument->getStringValue("display-mode", "arc");
- _rangeNm = _Instrument->getFloatValue("range", 40.0);
- _view_heading = fgGetDouble("/orientation/heading-deg") * SG_DEGREES_TO_RADIANS;
- _scale = 200.0;
-
- bool centre = _radar_centre_node->getBoolValue();
- if (centre) {
- _centerTrans = osg::Matrixf::identity();
- } else {
- _centerTrans = osg::Matrixf::identity();
+ _rangeNm = _rangeNode->getFloatValue();
+ if (_testModeNode->getBoolValue()) {
+ _view_heading = 90;
+ } else if (_Instrument->getBoolValue("aircraft-heading-up", true)) {
+ _view_heading = fgGetDouble("/orientation/heading-deg");
+ } else {
+ _view_heading = _Instrument->getFloatValue("heading-up-deg", 0.0);
+ }
+ _viewHeadingNode->setDoubleValue(_view_heading);
+
+ double xCenterFrac = _xCenterNode->getDoubleValue();
+ double yCenterFrac = _yCenterNode->getDoubleValue();
+ int pixelSize = _odg->size();
+
+ int rangePixels = _Instrument->getIntValue("range-pixels", -1);
+ if (rangePixels < 0) {
+ // hacky - assume (as is very common) that x-frac doesn't vary, and
+ // y-frac is used to position the center at either the top or bottom of
+ // the pixel area. Measure from the center to the furthest edge (top or bottom)
+ rangePixels = pixelSize * std::max(fabs(1.0 - yCenterFrac), fabs(yCenterFrac));
+ }
+
+ _scale = rangePixels / _rangeNm;
+ _Instrument->setDoubleValue("scale", _scale);
+
+
+ _centerTrans = osg::Matrixf::translate(xCenterFrac * pixelSize,
+ yCenterFrac * pixelSize, 0.0);
+
+// scale from nm to display units, rotate so aircraft heading is up
+// (as opposed to north), and compensate for centering
+ _projectMat = osg::Matrixf::scale(_scale, _scale, 1.0) *
+ degRotation(-_view_heading) * _centerTrans;
+
+ _pos = globals->get_aircraft_position();
+
+ // invalidate the cache of positioned items, if we travelled more than 1nm
+ if (_cachedItemsValid) {
+ SGVec3d cartNow(SGVec3d::fromGeod(_pos));
+ double movedNm = dist(_cachedPos, cartNow) * SG_METER_TO_NM;
+ _cachedItemsValid = (movedNm < 1.0);
}
- _drawData = _radar_data_node->getBoolValue();
- _pos = SGGeod::fromDegFt(_user_lon_node->getDoubleValue(),
- _user_lat_node->getDoubleValue(),
- _user_alt_node->getDoubleValue());
-
_vertices->clear();
_lineVertices->clear();
_lineColors->clear();
+ _quadColors->clear();
_texCoords->clear();
_textGeode->removeDrawables(0, _textGeode->getNumDrawables());
- update_aircraft();
- update_route();
+ BOOST_FOREACH(SymbolInstance* si, _symbols) {
+ delete si;
+ }
+ _symbols.clear();
+
+ BOOST_FOREACH(SymbolDef* d, _definitions) {
+ d->instanceCount = 0;
+ d->textEnabled = d->textEnable.get() ? d->textEnable->test() : true;
+ }
+
+ bool enableChanged = false;
+ BOOST_FOREACH(SymbolRule* r, _rules) {
+ enableChanged |= r->checkEnabled();
+ }
+
+ if (enableChanged) {
+ SG_LOG(SG_INSTR, SG_INFO, "NS rule enables changed, rebuilding cache");
+ _cachedItemsValid = false;
+ }
+ if (_testModeNode->getBoolValue()) {
+ addTestSymbols();
+ } else {
+ processRoute();
+ processNavRadios();
+ processAI();
+ findItems();
+ limitDisplayedSymbols();
+ }
+
+ addSymbolsToScene();
_symbolPrimSet->set(osg::PrimitiveSet::QUADS, 0, _vertices->size());
_symbolPrimSet->dirty();
_linePrimSet->dirty();
}
-osg::Matrixf NavDisplay::project(const SGGeod& geod) const
+
+void
+NavDisplay::updateFont()
{
- double rangeM, bearing, az2;
- SGGeodesy::inverse(_pos, geod, bearing, az2, rangeM);
-
- double radius = ((rangeM * SG_METER_TO_NM) / _rangeNm) * _scale;
- bearing *= SG_DEGREES_TO_RADIANS;
-
- return osg::Matrixf(wxRotate(_view_heading - bearing)
- * osg::Matrixf::translate(0.0f, radius, 0.0f)
- * wxRotate(bearing) * _centerTrans);
+ float red = _font_node->getFloatValue("color/red");
+ float green = _font_node->getFloatValue("color/green");
+ float blue = _font_node->getFloatValue("color/blue");
+ float alpha = _font_node->getFloatValue("color/alpha");
+ _font_color.set(red, green, blue, alpha);
+
+ _font_size = _font_node->getFloatValue("size");
+ _font_spacing = _font_size * _font_node->getFloatValue("line-spacing");
+ string path = _font_node->getStringValue("name", DEFAULT_FONT);
+ SGPath tpath;
+ if (path[0] != '/') {
+ tpath = globals->get_fg_root();
+ tpath.append("Fonts");
+ tpath.append(path);
+ } else {
+ tpath = path;
+ }
+
+ osg::ref_ptr<osgDB::ReaderWriter::Options> fontOptions = new osgDB::ReaderWriter::Options("monochrome");
+ osg::ref_ptr<osgText::Font> font = osgText::readFontFile(tpath.c_str(), fontOptions.get());
+
+ if (font != 0) {
+ _font = font;
+ _font->setMinFilterHint(osg::Texture::NEAREST);
+ _font->setMagFilterHint(osg::Texture::NEAREST);
+ _font->setGlyphImageMargin(0);
+ _font->setGlyphImageMarginRatio(0);
+ }
}
-void
-NavDisplay::addSymbol(const SGGeod& pos, int symbolIndex, const std::string& data)
+void NavDisplay::addSymbolToScene(SymbolInstance* sym)
{
- int symbolRow = symbolIndex >> 4;
- int symbolColumn = symbolIndex & 0x0f;
+ SymbolDef* def = sym->definition;
+
+ osg::Vec2 verts[4];
+ verts[0] = def->xy0;
+ verts[1] = osg::Vec2(def->xy1.x(), def->xy0.y());
+ verts[2] = def->xy1;
+ verts[3] = osg::Vec2(def->xy0.x(), def->xy1.y());
- const osg::Vec2f texBase(UNIT * symbolColumn, UNIT * symbolRow);
- float size = 600 * UNIT;
+ if (def->rotateToHeading) {
+ osg::Matrixf m(degRotation(sym->headingDeg - _view_heading));
+ for (int i=0; i<4; ++i) {
+ verts[i] = mult(verts[i], m);
+ }
+ }
+
+ osg::Vec2 pos = sym->pos;
+ if (def->roundPos) {
+ pos = osg::Vec2((int) pos.x(), (int) pos.y());
+ }
+
+ _texCoords->push_back(def->uv0);
+ _texCoords->push_back(osg::Vec2(def->uv1.x(), def->uv0.y()));
+ _texCoords->push_back(def->uv1);
+ _texCoords->push_back(osg::Vec2(def->uv0.x(), def->uv1.y()));
+
+ for (int i=0; i<4; ++i) {
+ _vertices->push_back(verts[i] + pos);
+ _quadColors->push_back(def->color);
+ }
+
+ if (def->stretchSymbol) {
+ osg::Vec2 stretchVerts[4];
+ stretchVerts[0] = osg::Vec2(def->xy0.x(), def->stretchY2);
+ stretchVerts[1] = osg::Vec2(def->xy1.x(), def->stretchY2);
+ stretchVerts[2] = osg::Vec2(def->xy1.x(), def->stretchY3);
+ stretchVerts[3] = osg::Vec2(def->xy0.x(), def->stretchY3);
+
+ osg::Matrixf m(degRotation(sym->headingDeg - _view_heading));
+ for (int i=0; i<4; ++i) {
+ stretchVerts[i] = mult(stretchVerts[i], m);
+ }
+
+ // stretched quad
+ _vertices->push_back(verts[2] + pos);
+ _vertices->push_back(stretchVerts[1] + sym->endPos);
+ _vertices->push_back(stretchVerts[0] + sym->endPos);
+ _vertices->push_back(verts[3] + pos);
+
+ _texCoords->push_back(def->uv1);
+ _texCoords->push_back(osg::Vec2(def->uv1.x(), def->stretchV2));
+ _texCoords->push_back(osg::Vec2(def->uv0.x(), def->stretchV2));
+ _texCoords->push_back(osg::Vec2(def->uv0.x(), def->uv1.y()));
+
+ for (int i=0; i<4; ++i) {
+ _quadColors->push_back(def->color);
+ }
+
+ // quad three, for the end portion
+ for (int i=0; i<4; ++i) {
+ _vertices->push_back(stretchVerts[i] + sym->endPos);
+ _quadColors->push_back(def->color);
+ }
+
+ _texCoords->push_back(osg::Vec2(def->uv0.x(), def->stretchV2));
+ _texCoords->push_back(osg::Vec2(def->uv1.x(), def->stretchV2));
+ _texCoords->push_back(osg::Vec2(def->uv1.x(), def->stretchV3));
+ _texCoords->push_back(osg::Vec2(def->uv0.x(), def->stretchV3));
+ }
- osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f)
- * project(pos));
- addQuad(_vertices, _texCoords, m, texBase);
+ if (def->drawLine) {
+ addLine(sym->pos, sym->endPos, def->lineColor);
+ }
- if (!_drawData) {
+ if (!def->hasText || !def->textEnabled) {
return;
}
-
-// add data drawable
- osgText::Text* text = new osgText::Text;
- text->setFont(_font.get());
- text->setFontResolution(12, 12);
- text->setCharacterSize(_font_size);
-
- osg::Vec3 dataPos = m.preMult(osg::Vec3(16, 16, 0));
- text->setLineSpacing(_font_spacing);
- text->setAlignment(osgText::Text::LEFT_CENTER);
- text->setText(data);
- text->setPosition(osg::Vec3((int) dataPos.x(), (int)dataPos.y(), 0));
- _textGeode->addDrawable(text);
+ osgText::Text* t = new osgText::Text;
+ t->setFont(_font.get());
+ t->setFontResolution(12, 12);
+ t->setCharacterSize(_font_size);
+ t->setLineSpacing(_font_spacing);
+ t->setColor(def->textColor);
+ t->setAlignment(def->alignment);
+ t->setText(sym->text());
+
+
+ osg::Vec2 textPos = def->textOffset + pos;
+// ensure we use ints here, or text visual quality goes bad
+ t->setPosition(osg::Vec3((int)textPos.x(), (int)textPos.y(), 0));
+ _textGeode->addDrawable(t);
}
-void
-NavDisplay::update_route()
+class OrderByPriority
+{
+public:
+ bool operator()(SymbolInstance* a, SymbolInstance* b)
+ {
+ return a->definition->priority > b->definition->priority;
+ }
+};
+
+void NavDisplay::limitDisplayedSymbols()
{
- if (_route->numWaypts() < 2) {
+// gloabl symbol limit
+ _maxSymbols= _Instrument->getIntValue("max-symbols", _maxSymbols);
+ if ((int) _symbols.size() <= _maxSymbols) {
+ _excessDataNode->setBoolValue(false);
return;
}
- RoutePath path(_route->waypts());
- for (int w=0; w<_route->numWaypts(); ++w) {
- bool isPast = w < _route->currentIndex();
- SGGeodVec gv(path.pathForIndex(w));
- if (!gv.empty()) {
- osg::Vec3 color(1.0, 0.0, 1.0);
- if (isPast) {
- color = osg::Vec3(0.5, 0.5, 0.5);
- }
-
- osg::Vec3 pr = project(gv[0]).preMult(osg::Vec3(0.0, 0.0, 0.0));
- for (unsigned int i=1; i<gv.size(); ++i) {
- _lineVertices->push_back(osg::Vec2(pr.x(), pr.y()));
- pr = project(gv[i]).preMult(osg::Vec3(0.0, 0.0, 0.0));
- _lineVertices->push_back(osg::Vec2(pr.x(), pr.y()));
-
- _lineColors->push_back(color);
- _lineColors->push_back(color);
+ std::sort(_symbols.begin(), _symbols.end(), OrderByPriority());
+ _symbols.resize(_maxSymbols);
+ _excessDataNode->setBoolValue(true);
+}
+
+class OrderByZ
+{
+public:
+ bool operator()(SymbolInstance* a, SymbolInstance* b)
+ {
+ return a->definition->zOrder > b->definition->zOrder;
+ }
+};
+
+void NavDisplay::addSymbolsToScene()
+{
+ std::sort(_symbols.begin(), _symbols.end(), OrderByZ());
+ BOOST_FOREACH(SymbolInstance* sym, _symbols) {
+ addSymbolToScene(sym);
+ }
+}
+
+void NavDisplay::addLine(osg::Vec2 a, osg::Vec2 b, const osg::Vec4& color)
+{
+ _lineVertices->push_back(a);
+ _lineVertices->push_back(b);
+ _lineColors->push_back(color);
+ _lineColors->push_back(color);
+}
+
+osg::Vec2 NavDisplay::projectBearingRange(double bearingDeg, double rangeNm) const
+{
+ osg::Vec3 p(0, rangeNm, 0.0);
+ p = degRotation(bearingDeg).preMult(p);
+ p = _projectMat.preMult(p);
+ return osg::Vec2(p.x(), p.y());
+}
+
+osg::Vec2 NavDisplay::projectGeod(const SGGeod& geod) const
+{
+ double rangeM, bearing, az2;
+ SGGeodesy::inverse(_pos, geod, bearing, az2, rangeM);
+ return projectBearingRange(bearing, rangeM * SG_METER_TO_NM);
+}
+
+class Filter : public FGPositioned::Filter
+{
+public:
+ Filter(NavDisplay* nd) : _owner(nd) { }
+
+ double minRunwayLengthFt;
+
+ virtual bool pass(FGPositioned* aPos) const
+ {
+ if (aPos->type() == FGPositioned::FIX) {
+ string ident(aPos->ident());
+ // ignore fixes which end in digits
+ if ((ident.size() > 4) && isdigit(ident[3]) && isdigit(ident[4])) {
+ return false;
}
- } // of line drawing
-
- flightgear::WayptRef wpt(_route->wayptAtIndex(w));
- SGGeod g = path.positionForIndex(w);
- int symbolIndex = isPast ? 1 : 0;
- if (!(g == SGGeod())) {
- std::string data = wpt->ident();
- addSymbol(g, symbolIndex, data);
}
- } // of waypoints iteration
-}
-void
-NavDisplay::update_aircraft()
+ if (aPos->type() == FGPositioned::AIRPORT) {
+ FGAirport* apt = (FGAirport*) aPos;
+ if (!apt->hasHardRunwayOfLengthFt(minRunwayLengthFt)) {
+ return false;
+ }
+ }
+
+ // check against current rule states
+ return _owner->isPositionedShown(aPos);
+ }
+
+ virtual FGPositioned::Type minType() const {
+ return FGPositioned::AIRPORT;
+ }
+
+ virtual FGPositioned::Type maxType() const {
+ return FGPositioned::OBSTACLE;
+ }
+
+private:
+ NavDisplay* _owner;
+};
+
+void NavDisplay::findItems()
{
- if (!_ai_enabled_node->getBoolValue()) {
- return;
+ if (!_cachedItemsValid) {
+ Filter filt(this);
+ filt.minRunwayLengthFt = fgGetDouble("/sim/navdb/min-runway-length-ft", 2000);
+ _itemsInRange = FGPositioned::findClosestN(_pos, _maxSymbols, _rangeNm, &filt);
+ _cachedItemsValid = true;
+ _cachedPos = SGVec3d::fromGeod(_pos);
+ }
+
+ // sort by distance from pos, so symbol limits are accurate
+ FGPositioned::sortByRange(_itemsInRange, _pos);
+
+ BOOST_FOREACH(FGPositioned* pos, _itemsInRange) {
+ foundPositionedItem(pos);
}
+}
- 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;
+void NavDisplay::processRoute()
+{
+ _routeSources.clear();
+ flightgear::FlightPlan* fp = _route->flightPlan();
+ RoutePath path(fp);
+ int current = _route->currentIndex();
- const SGPropertyNode *ai = fgGetNode("/ai/models", true);
- for (int i = ai->nChildren() - 1; i >= 0; i--) {
- const SGPropertyNode *model = ai->getChild(i);
- if (!model->nChildren()) {
- continue;
+ for (int l=0; l<fp->numLegs(); ++l) {
+ flightgear::FlightPlan::Leg* leg = fp->legAtIndex(l);
+ flightgear::WayptRef wpt(leg->waypoint());
+ _routeSources.insert(wpt->source());
+
+ string_set state;
+ state.insert("on-active-route");
+
+ if (l < current) {
+ state.insert("passed");
+ }
+
+ if (l == current) {
+ state.insert("current-wp");
+ }
+
+ if (l > current) {
+ state.insert("future");
+ }
+
+ if (l == (current + 1)) {
+ state.insert("next-wp");
+ }
+
+ SymbolRuleVector rules;
+ findRules("waypoint" , state, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
}
- double echo_radius, sigma;
- const string name = model->getName();
-
- if (name == "aircraft" || name == "tanker")
- echo_radius = 1, sigma = 1;
- else if (name == "multiplayer" || name == "wingman" || name == "static")
- echo_radius = 1.5, sigma = 1;
- else if (name == "ship" || name == "carrier" || name == "escort" ||name == "storm")
- echo_radius = 1.5, sigma = 100;
- else if (name == "thermal")
- echo_radius = 2, sigma = 100;
- else if (name == "rocket")
- echo_radius = 0.1, sigma = 0.1;
- else if (name == "ballistic")
- echo_radius = 0.001, sigma = 0.001;
- else
- continue;
-
- SGGeod aiModelPos = SGGeod::fromDegFt(model->getDoubleValue("position/longitude-deg"),
- model->getDoubleValue("position/latitude-deg"),
- model->getDoubleValue("position/altitude-ft"));
+ SGGeod g = path.positionForIndex(l);
+ SGPropertyNode* vars = _route->wayptNodeAtIndex(l);
+ if (!vars) {
+ continue; // shouldn't happen, but let's guard against it
+ }
- double heading = model->getDoubleValue("orientation/true-heading-deg");
- double rangeM, bearing, az2;
- SGGeodesy::inverse(_pos, aiModelPos, bearing, az2, rangeM);
+ double heading;
+ computeWayptPropsAndHeading(wpt, g, vars, heading);
- // if (!inRadarRange(sigma, rangeM))
- // continue;
+ osg::Vec2 projected = projectGeod(g);
+ BOOST_FOREACH(SymbolRule* r, rules) {
+ addSymbolInstance(projected, heading, r->getDefinition(), vars);
+
+ if (r->getDefinition()->drawRouteLeg) {
+ SGGeodVec gv(path.pathForIndex(l));
+ if (!gv.empty()) {
+ osg::Vec2 pr = projectGeod(gv[0]);
+ for (unsigned int i=1; i<gv.size(); ++i) {
+ osg::Vec2 p = projectGeod(gv[i]);
+ addLine(pr, p, r->getDefinition()->lineColor);
+ pr = p;
+ }
+ }
+ } // of leg drawing enabled
+ } // of matching rules iteration
+ } // of waypoints iteration
+}
- bearing *= SG_DEGREES_TO_RADIANS;
- heading *= SG_DEGREES_TO_RADIANS;
+void NavDisplay::computeWayptPropsAndHeading(flightgear::Waypt* wpt, const SGGeod& pos, SGPropertyNode* nd, double& heading)
+{
+ double rangeM, az2;
+ SGGeodesy::inverse(_pos, pos, heading, az2, rangeM);
+ nd->setIntValue("radial", heading);
+ nd->setDoubleValue("distance-nm", rangeM * SG_METER_TO_NM);
+
+ heading = nd->getDoubleValue("leg-bearing-true-deg");
+}
- float radius = rangeM * _scale;
- // float angle = relativeBearing(bearing, _view_heading);
+void NavDisplay::processNavRadios()
+{
+ _nav1Station = processNavRadio(_navRadio1Node);
+ _nav2Station = processNavRadio(_navRadio2Node);
+
+ foundPositionedItem(_nav1Station);
+ foundPositionedItem(_nav2Station);
+}
+
+FGNavRecord* NavDisplay::processNavRadio(const SGPropertyNode_ptr& radio)
+{
+ double mhz = radio->getDoubleValue("frequencies/selected-mhz", 0.0);
+ FGNavRecord* nav = FGNavList::findByFreq(mhz, _pos, FGNavList::navFilter());
+ if (!nav || (nav->ident() != radio->getStringValue("nav-id"))) {
+ // station was not found
+ return NULL;
+ }
+
+
+ return nav;
+}
- bool is_tcas_contact = false;
- if (draw_tcas)
- {
- is_tcas_contact = update_tcas(model,rangeM,
- _pos.getElevationFt(),
- aiModelPos.getElevationFt(),
- bearing,radius,draw_absolute);
+bool NavDisplay::anyRuleForType(const string& type) const
+{
+ BOOST_FOREACH(SymbolRule* r, _rules) {
+ if (!r->enabled) {
+ continue;
+ }
+
+ if (r->type == type) {
+ return true;
}
+ }
+
+ return false;
+}
- // data mode
- 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);
- addQuad(_vertices, _texCoords, m, texBase);
+void NavDisplay::findRules(const string& type, const string_set& states, SymbolRuleVector& rules)
+{
+ BOOST_FOREACH(SymbolRule* candidate, _rules) {
+ if (!candidate->enabled || (candidate->type != type)) {
+ continue;
+ }
+
+ if (candidate->matches(states)) {
+ rules.push_back(candidate);
}
+ }
+}
+
+bool NavDisplay::isPositionedShown(FGPositioned* pos)
+{
+ SymbolRuleVector rules;
+ isPositionedShownInner(pos, rules);
+ return !rules.empty();
+}
- if (draw_data || is_tcas_contact) {
- update_data(model, aiModelPos.getElevationFt(), heading, radius, bearing, false);
+void NavDisplay::isPositionedShownInner(FGPositioned* pos, SymbolRuleVector& rules)
+{
+ string type = FGPositioned::nameForType(pos->type());
+ boost::to_lower(type);
+ if (!anyRuleForType(type)) {
+ return; // not diplayed at all, we're done
+ }
+
+ string_set states;
+ computePositionedState(pos, states);
+
+ findRules(type, states, rules);
+}
+
+void NavDisplay::foundPositionedItem(FGPositioned* pos)
+{
+ if (!pos) {
+ return;
+ }
+
+ SymbolRuleVector rules;
+ isPositionedShownInner(pos, rules);
+ if (rules.empty()) {
+ return;
+ }
+
+ SGPropertyNode_ptr vars(new SGPropertyNode);
+ double heading;
+ computePositionedPropsAndHeading(pos, vars, heading);
+
+ osg::Vec2 projected = projectGeod(pos->geod());
+ if (pos->type() == FGPositioned::RUNWAY) {
+ FGRunway* rwy = (FGRunway*) pos;
+ projected = projectGeod(rwy->threshold());
+ }
+
+ BOOST_FOREACH(SymbolRule* r, rules) {
+ SymbolInstance* ins = addSymbolInstance(projected, heading, r->getDefinition(), vars);
+ if ((ins)&&(pos->type() == FGPositioned::RUNWAY)) {
+ FGRunway* rwy = (FGRunway*) pos;
+ ins->endPos = projectGeod(rwy->end());
}
- } // of ai models iteration
+ }
}
-/** Update TCAS display.
- * Return true when processed as TCAS contact, false otherwise. */
-bool
-NavDisplay::update_tcas(const SGPropertyNode *model,double range,double user_alt,double alt,
- double bearing,double radius,bool absMode)
+void NavDisplay::computePositionedPropsAndHeading(FGPositioned* pos, SGPropertyNode* nd, double& heading)
{
- 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;
+ nd->setStringValue("id", pos->ident());
+ nd->setStringValue("name", pos->name());
+ nd->setDoubleValue("elevation-ft", pos->elevation());
+ nd->setIntValue("heading-deg", 0);
+ heading = 0.0;
+
+ switch (pos->type()) {
+ case FGPositioned::VOR:
+ case FGPositioned::LOC:
+ case FGPositioned::TACAN: {
+ FGNavRecord* nav = static_cast<FGNavRecord*>(pos);
+ nd->setDoubleValue("frequency-mhz", nav->get_freq());
+
+ if (pos == _nav1Station) {
+ heading = _navRadio1Node->getDoubleValue("radials/target-radial-deg");
+ } else if (pos == _nav2Station) {
+ heading = _navRadio2Node->getDoubleValue("radials/target-radial-deg");
}
- 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);
+
+ nd->setIntValue("heading-deg", heading);
+ break;
}
- {
- // 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 NavDisplay::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());
- callsign->setFontResolution(12, 12);
- 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::Vec3 pos = m.preMult(osg::Vec3(16, 16, 0));
- // cast to int's, otherwise text comes out ugly
- callsign->setPosition(osg::Vec3((int)pos.x(), (int)pos.y(), 0));
- 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 << 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);
+ case FGPositioned::AIRPORT:
+ case FGPositioned::SEAPORT:
+ case FGPositioned::HELIPORT:
+
+ break;
+
+ case FGPositioned::RUNWAY: {
+ FGRunway* rwy = static_cast<FGRunway*>(pos);
+ heading = rwy->headingDeg();
+ nd->setDoubleValue("heading-deg", heading);
+ nd->setIntValue("length-ft", rwy->lengthFt());
+ nd->setStringValue("airport", rwy->airport()->ident());
+ break;
+ }
+
+ default:
+ break;
+ }
}
-void
-NavDisplay::updateFont()
+void NavDisplay::computePositionedState(FGPositioned* pos, string_set& states)
{
- float red = _font_node->getFloatValue("color/red");
- float green = _font_node->getFloatValue("color/green");
- float blue = _font_node->getFloatValue("color/blue");
- float alpha = _font_node->getFloatValue("color/alpha");
- _font_color.set(red, green, blue, alpha);
+ if (_routeSources.count(pos) != 0) {
+ states.insert("on-active-route");
+ }
+
+ flightgear::FlightPlan* fp = _route->flightPlan();
+ switch (pos->type()) {
+ case FGPositioned::VOR:
+ case FGPositioned::LOC:
+ if (pos == _nav1Station) {
+ states.insert("tuned");
+ states.insert("nav1");
+ }
+
+ if (pos == _nav2Station) {
+ states.insert("tuned");
+ states.insert("nav2");
+ }
+ break;
+
+ case FGPositioned::AIRPORT:
+ case FGPositioned::SEAPORT:
+ case FGPositioned::HELIPORT:
+ // mark alternates!
+ // once the FMS system has some way to tell us about them, of course
+
+ if (pos == fp->departureAirport()) {
+ states.insert("departure");
+ }
+
+ if (pos == fp->destinationAirport()) {
+ states.insert("destination");
+ }
+ break;
+
+ case FGPositioned::RUNWAY:
+ if (pos == fp->departureRunway()) {
+ states.insert("departure");
+ }
+
+ if (pos == fp->destinationRunway()) {
+ states.insert("destination");
+ }
+ break;
+
+ case FGPositioned::OBSTACLE:
+ #if 0
+ FGObstacle* obs = (FGObstacle*) pos;
+ if (obj->isLit()) {
+ states.insert("lit");
+ }
+
+ if (obj->getHeightAGLFt() >= 1000) {
+ states.insert("greater-1000-ft");
+ }
+ #endif
+ break;
+
+ default:
+ break;
+ } // FGPositioned::Type switch
+}
- _font_size = _font_node->getFloatValue("size");
- _font_spacing = _font_size * _font_node->getFloatValue("line-spacing");
- string path = _font_node->getStringValue("name", DEFAULT_FONT);
+static string mapAINodeToType(SGPropertyNode* model)
+{
+ // assume all multiplayer items are aircraft for the moment. Not ideal.
+ if (!strcmp(model->getName(), "multiplayer")) {
+ return "ai-aircraft";
+ }
+
+ return string("ai-") + model->getName();
+}
- SGPath tpath;
- if (path[0] != '/') {
- tpath = globals->get_fg_root();
- tpath.append("Fonts");
- tpath.append(path);
- } else {
- tpath = path;
- }
+void NavDisplay::processAI()
+{
+ SGPropertyNode *ai = fgGetNode("/ai/models", true);
+ for (int i = ai->nChildren() - 1; i >= 0; i--) {
+ SGPropertyNode *model = ai->getChild(i);
+ if (!model->nChildren()) {
+ continue;
+ }
+
+ // prefix types with 'ai-', to avoid any chance of namespace collisions
+ // with fg-positioned.
+ string_set ss;
+ computeAIStates(model, ss);
+ SymbolRuleVector rules;
+ findRules(mapAINodeToType(model), ss, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
+ }
-#if (FG_OSG_VERSION >= 21000)
- osg::ref_ptr<osgDB::ReaderWriter::Options> fontOptions = new osgDB::ReaderWriter::Options("monochrome");
- osg::ref_ptr<osgText::Font> font = osgText::readFontFile(tpath.c_str(), fontOptions.get());
-#else
- osg::ref_ptr<osgText::Font> font = osgText::readFontFile(tpath.c_str());
-#endif
+ double heading = model->getDoubleValue("orientation/true-heading-deg");
+ SGGeod aiModelPos = SGGeod::fromDegFt(model->getDoubleValue("position/longitude-deg"),
+ model->getDoubleValue("position/latitude-deg"),
+ model->getDoubleValue("position/altitude-ft"));
+ // compute some additional props
+ int fl = (aiModelPos.getElevationFt() / 1000);
+ model->setIntValue("flight-level", fl * 10);
+
+ osg::Vec2 projected = projectGeod(aiModelPos);
+ BOOST_FOREACH(SymbolRule* r, rules) {
+ addSymbolInstance(projected, heading, r->getDefinition(), (SGPropertyNode*) model);
+ }
+ } // of ai models iteration
+}
- if (font != 0) {
- _font = font;
- _font->setMinFilterHint(osg::Texture::NEAREST);
- _font->setMagFilterHint(osg::Texture::NEAREST);
- _font->setGlyphImageMargin(0);
- _font->setGlyphImageMarginRatio(0);
+void NavDisplay::computeAIStates(const SGPropertyNode* ai, string_set& states)
+{
+ int threatLevel = ai->getIntValue("tcas/threat-level",-1);
+ if (threatLevel < 1)
+ threatLevel = 0;
+
+ states.insert("tcas");
+
+ std::ostringstream os;
+ os << "tcas-threat-level-" << threatLevel;
+ states.insert(os.str());
+
+ double vspeed = ai->getDoubleValue("velocities/vertical-speed-fps");
+ if (vspeed < -3.0) {
+ states.insert("descending");
+ } else if (vspeed > 3.0) {
+ states.insert("climbing");
}
+}
- 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);
+SymbolInstance* NavDisplay::addSymbolInstance(const osg::Vec2& proj, double heading, SymbolDef* def, SGPropertyNode* vars)
+{
+ if (isProjectedClipped(proj)) {
+ return NULL;
}
+
+ if ((def->limitCount > 0) && (def->instanceCount >= def->limitCount)) {
+ return NULL;
+ }
+
+ ++def->instanceCount;
+ SymbolInstance* sym = new SymbolInstance(proj, heading, def, vars);
+ _symbols.push_back(sym);
+ return sym;
+}
+
+bool NavDisplay::isProjectedClipped(const osg::Vec2& projected) const
+{
+ double size = _odg->size();
+ return (projected.x() < 0.0) ||
+ (projected.y() < 0.0) ||
+ (projected.x() >= size) ||
+ (projected.y() >= size);
+}
+
+void NavDisplay::addTestSymbol(const std::string& type, const std::string& states, const SGGeod& pos, double heading, SGPropertyNode* vars)
+{
+ string_set stateSet;
+ BOOST_FOREACH(std::string s, simgear::strutils::split(states, ",")) {
+ stateSet.insert(s);
+ }
+
+ SymbolRuleVector rules;
+ findRules(type, stateSet, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
+ }
+
+ osg::Vec2 projected = projectGeod(pos);
+ BOOST_FOREACH(SymbolRule* r, rules) {
+ addSymbolInstance(projected, heading, r->getDefinition(), vars);
+ }
+}
+
+void NavDisplay::addTestSymbols()
+{
+ _pos = SGGeod::fromDeg(-122.3748889, 37.6189722); // KSFO
+
+ SGGeod a1;
+ double dummy;
+ SGGeodesy::direct(_pos, 45.0, 20.0 * SG_NM_TO_METER, a1, dummy);
+
+ addTestSymbol("airport", "", a1, 0.0, NULL);
+
+ SGGeodesy::direct(_pos, 95.0, 40.0 * SG_NM_TO_METER, a1, dummy);
+
+ addTestSymbol("vor", "", a1, 0.0, NULL);
+
+ SGGeodesy::direct(_pos, 120, 80.0 * SG_NM_TO_METER, a1, dummy);
+
+ addTestSymbol("airport", "destination", a1, 0.0, NULL);
+
+ SGGeodesy::direct(_pos, 80.0, 20.0 * SG_NM_TO_METER, a1, dummy);
+ addTestSymbol("fix", "", a1, 0.0, NULL);
+
+
+ SGGeodesy::direct(_pos, 140.0, 20.0 * SG_NM_TO_METER, a1, dummy);
+ addTestSymbol("fix", "", a1, 0.0, NULL);
+
+ SGGeodesy::direct(_pos, 110.0, 10.0 * SG_NM_TO_METER, a1, dummy);
+ addTestSymbol("fix", "", a1, 0.0, NULL);
+
+ SGGeodesy::direct(_pos, 110.0, 5.0 * SG_NM_TO_METER, a1, dummy);
+ addTestSymbol("fix", "", a1, 0.0, NULL);
}
+void NavDisplay::addRule(SymbolRule* r)
+{
+ _rules.push_back(r);
+}
projects / flightgear.git / blobdiff