#include "NavDisplay.hxx"
+#include <cassert>
+#include <boost/foreach.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 "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') >= 0) {
+ ::snprintf(buf, 512, format.c_str(), nd->getIntValue());
+ return buf;
+ }
+
+ if (format.find('s') >= 0) {
+ ::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 SymbolDef
+{
+public:
+ void initFromNode(SGPropertyNode* node)
+ {
+ type = node->getStringValue("type");
+ enable = sgReadCondition(fgGetNode("/"), node->getChild("enable"));
+ 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
+
+ xy0.x() = node->getFloatValue("x0", -5);
+ xy0.y() = node->getFloatValue("y0", -5);
+ xy1.x() = node->getFloatValue("x1", 5);
+ xy1.y() = node->getFloatValue("y1", 5);
+
+ double texSize = node->getFloatValue("texture-size", 1.0);
+
+ 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);
+ }
+
+ drawLine = node->getBoolValue("draw-line", false);
+ lineColor = readColor(node->getChild("line-color"), color);
+ drawRouteLeg = node->getBoolValue("draw-line", false);
+
+ stretchSymbol = node->getBoolValue("stretch-symbol", false);
+ if (stretchSymbol) {
+ stretchY2 = node->getFloatValue("y2");
+ stretchY3 = node->getFloatValue("y3");
+ stretchV2 = node->getFloatValue("v2");
+ stretchV3 = node->getFloatValue("v3");
+ }
+ }
+
+ SGCondition* enable;
+ bool enabled; // cached enabled state
+
+ std::string type;
+ string_set required_states;
+ string_set excluded_states;
+
+ 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;
+ 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;
+
+ bool matches(const string_set& states) const
+ {
+ string_set::const_iterator it = states.begin(),
+ end = states.end();
+ for (; it != end; ++it) {
+ if (required_states.count(*it) == 0) {
+ // required state not matched
+ return false;
+ }
+
+ if (excluded_states.count(*it) > 0) {
+ // excluded state matched
+ return false;
+ }
+ } // of applicable states iteration
+
+ return true; // matches!
+ }
+};
+
+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;
+
+ int pos = 0;
+ int lastPos = 0;
+
+ for (; pos < (int) definition->textTemplate.size();) {
+ pos = definition->textTemplate.find('{', pos);
+ if (pos == -1) { // no more replacements
+ r.append(definition->textTemplate.substr(lastPos));
+ break;
+ }
+
+ r.append(definition->textTemplate.substr(lastPos, pos - lastPos));
+
+ int 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
+ int colonPos = spec.find(':');
+ if (colonPos < 0) {
+ // 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)),
_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),
SGPath tpath = globals->resolve_aircraft_path(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");
_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);
+
// 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());
+
// 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;
+ _geom->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
+ _geom->setColorArray(_quadColors);
_symbolPrimSet = new osg::DrawArrays(osg::PrimitiveSet::QUADS);
_symbolPrimSet->setDataVariance(osg::Object::DYNAMIC);
_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)
{
}
_time += delta_time_sec;
- if (_time < _interval){
+ if (_time < _updateInterval){
return;
}
- _time -= _interval;
+ _time -= _updateInterval;
- 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();
- }
-
- _drawData = _radar_data_node->getBoolValue();
+ if (_Instrument->getBoolValue("aircraft-heading-up", true)) {
+ _view_heading = fgGetDouble("/orientation/heading-deg");
+ } else {
+ _view_heading = _Instrument->getFloatValue("heading-up-deg", 0.0);
+ }
+
+ _scale = _odg->size() / _rangeNm;
+
+ double xCenterFrac = _Instrument->getDoubleValue("x-center", 0.5);
+ double yCenterFrac = _Instrument->getDoubleValue("y-center", 0.5);
+ _centerTrans = osg::Matrixf::translate(xCenterFrac * _odg->size(),
+ yCenterFrac * _odg->size(), 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 = SGGeod::fromDegFt(_user_lon_node->getDoubleValue(),
_user_lat_node->getDoubleValue(),
_user_alt_node->getDoubleValue());
_texCoords->clear();
_textGeode->removeDrawables(0, _textGeode->getNumDrawables());
- update_aircraft();
- update_route();
+ BOOST_FOREACH(SymbolDef* def, _rules) {
+ def->enabled = def->enable->test();
+ }
+ 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;
+ }
+
+#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
+ 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());
+
+ if (def->rotateToHeading) {
+ osg::Matrixf m(degRotation(sym->headingDeg));
+ 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());
+ }
- const osg::Vec2f texBase(UNIT * symbolColumn, UNIT * symbolRow);
- float size = 600 * UNIT;
+ _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()));
- osg::Matrixf m(osg::Matrixf::scale(size, size, 1.0f)
- * project(pos));
- addQuad(_vertices, _texCoords, m, texBase);
+ for (int i=0; i<4; ++i) {
+ _vertices->push_back(verts[i] + pos);
+ _quadColors->push_back(def->color);
+ }
- if (!_drawData) {
+ 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));
+ 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));
+ }
+
+ if (def->drawLine) {
+ addLine(sym->pos, sym->endPos, def->lineColor);
+ }
+
+ if (!def->hasText) {
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
{
- if (_route->numWaypts() < 2) {
+public:
+ bool operator()(SymbolInstance* a, SymbolInstance* b)
+ {
+ return a->definition->priority > b->definition->priority;
+ }
+};
+
+void NavDisplay::limitDisplayedSymbols()
+{
+ unsigned int maxSymbols = _Instrument->getIntValue("max-symbols");
+ if (_symbols.size() <= maxSymbols) {
+ _excessDataNode->setBoolValue(false);
return;
}
+ 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:
+ 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;
+ }
+ }
+
+ return true;
+ }
+
+ virtual FGPositioned::Type minType() const {
+ return FGPositioned::AIRPORT;
+ }
+
+ virtual FGPositioned::Type maxType() const {
+ return FGPositioned::OBSTACLE;
+ }
+};
+
+void NavDisplay::findItems()
+{
+ Filter filt;
+ FGPositioned::List items =
+ FGPositioned::findWithinRange(_pos, _rangeNm, &filt);
+
+ FGPositioned::List::const_iterator it;
+ for (it = items.begin(); it != items.end(); ++it) {
+ foundPositionedItem(*it);
+ }
+}
+
+void NavDisplay::processRoute()
+{
+ _routeSources.clear();
RoutePath path(_route->waypts());
+ int current = _route->currentIndex();
+
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);
- }
- } // 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);
+ _routeSources.insert(wpt->source());
+
+ string_set state;
+ state.insert("on-active-route");
+
+ if (w < current) {
+ state.insert("passed");
+ }
+
+ if (w == current) {
+ state.insert("current-wp");
}
+
+ if (w > current) {
+ state.insert("future");
+ }
+
+ if (w == (current + 1)) {
+ state.insert("next-wp");
+ }
+
+ SymbolDefVector rules;
+ findRules(wpt->type() , state, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
+ }
+
+ SGGeod g = path.positionForIndex(w);
+ SGPropertyNode* vars = _route->wayptNodeAtIndex(w);
+ double heading;
+ computeWayptPropsAndHeading(wpt, g, vars, heading);
+
+ osg::Vec2 projected = projectGeod(g);
+ BOOST_FOREACH(SymbolDef* r, rules) {
+ addSymbolInstance(projected, heading, r, vars);
+
+ if (r->drawRouteLeg) {
+ SGGeodVec gv(path.pathForIndex(w));
+ 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->lineColor);
+ pr = p;
+ }
+ }
+ } // of leg drawing enabled
+ } // of matching rules iteration
} // of waypoints iteration
}
-void
-NavDisplay::update_aircraft()
+void NavDisplay::computeWayptPropsAndHeading(flightgear::Waypt* wpt, const SGGeod& pos, SGPropertyNode* nd, double& heading)
{
- if (!_ai_enabled_node->getBoolValue()) {
- return;
- }
+ 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");
+}
- 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::processNavRadios()
+{
+ _nav1Station = processNavRadio(_navRadio1Node);
+ _nav2Station = processNavRadio(_navRadio2Node);
- 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()) {
+ foundPositionedItem(_nav1Station);
+ foundPositionedItem(_nav2Station);
+}
+
+FGNavRecord* NavDisplay::processNavRadio(const SGPropertyNode_ptr& radio)
+{
+ double mhz = radio->getDoubleValue("frequencies/selected-mhz", 0.0);
+ FGNavRecord* nav = globals->get_navlist()->findByFreq(mhz, _pos);
+ if (!nav || (nav->ident() != radio->getStringValue("nav-id"))) {
+ // station was not found
+ return NULL;
+ }
+
+
+ return nav;
+}
+
+bool NavDisplay::anyRuleForType(const string& type) const
+{
+ BOOST_FOREACH(SymbolDef* r, _rules) {
+ if (!r->enabled) {
continue;
}
+
+ if (r->type == type) {
+ return true;
+ }
+ }
+
+ return false;
+}
- 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
+bool NavDisplay::anyRuleMatches(const string& type, const string_set& states) const
+{
+ BOOST_FOREACH(SymbolDef* r, _rules) {
+ if (!r->enabled || (r->type != type)) {
continue;
-
- SGGeod aiModelPos = SGGeod::fromDegFt(model->getDoubleValue("position/longitude-deg"),
- model->getDoubleValue("position/latitude-deg"),
- model->getDoubleValue("position/altitude-ft"));
-
- double heading = model->getDoubleValue("orientation/true-heading-deg");
- double rangeM, bearing, az2;
- SGGeodesy::inverse(_pos, aiModelPos, bearing, az2, rangeM);
-
- // if (!inRadarRange(sigma, rangeM))
- // continue;
-
- bearing *= SG_DEGREES_TO_RADIANS;
- heading *= SG_DEGREES_TO_RADIANS;
-
- float radius = rangeM * _scale;
- // float angle = relativeBearing(bearing, _view_heading);
-
- bool is_tcas_contact = false;
- if (draw_tcas)
- {
- is_tcas_contact = update_tcas(model,rangeM,
- _pos.getElevationFt(),
- aiModelPos.getElevationFt(),
- bearing,radius,draw_absolute);
}
- // 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);
+ if (r->matches(states)) {
+ return true;
}
+ } // of rules iteration
+
+ return false;
+}
- if (draw_data || is_tcas_contact) {
- update_data(model, aiModelPos.getElevationFt(), heading, radius, bearing, false);
+void NavDisplay::findRules(const string& type, const string_set& states, SymbolDefVector& rules)
+{
+ BOOST_FOREACH(SymbolDef* candidate, _rules) {
+ if (!candidate->enabled) {
+ continue;
}
- } // of ai models iteration
+
+ if (candidate->matches(states)) {
+ rules.push_back(candidate);
+ }
+ }
}
-/** 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::foundPositionedItem(FGPositioned* pos)
{
- 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;
+ if (!pos) {
+ return;
+ }
+
+ string type = FGPositioned::nameForType(pos->type());
+ if (!anyRuleForType(type)) {
+ return; // not diplayed at all, we're done
+ }
+
+ string_set states;
+ computePositionedState(pos, states);
+
+ SymbolDefVector rules;
+ findRules(type, states, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
+ }
+
+ SGPropertyNode_ptr vars(new SGPropertyNode);
+ double heading;
+ computePositionedPropsAndHeading(pos, vars, heading);
+
+ osg::Vec2 projected = projectGeod(pos->geod());
+ BOOST_FOREACH(SymbolDef* r, rules) {
+ addSymbolInstance(projected, heading, r, vars);
+ }
+}
+
+void NavDisplay::computePositionedPropsAndHeading(FGPositioned* pos, SGPropertyNode* nd, double& heading)
+{
+ nd->setStringValue("id", pos->ident());
+ nd->setStringValue("name", pos->name());
+ nd->setDoubleValue("elevation-ft", pos->elevation());
+ nd->setIntValue("heading-deg", 0);
+
+ switch (pos->type()) {
+ case FGPositioned::VOR:
+ case FGPositioned::LOC: {
+ FGNavRecord* nav = static_cast<FGNavRecord*>(pos);
+ nd->setDoubleValue("frequency-mhz", nav->get_freq());
+
+ if (pos == _nav1Station) {
+ nd->setIntValue("heading-deg", _navRadio1Node->getDoubleValue("radials/target-radial-deg"));
+ } else if (pos == _nav2Station) {
+ nd->setIntValue("heading-deg", _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);
+
+ 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;
+ case FGPositioned::AIRPORT:
+ case FGPositioned::SEAPORT:
+ case FGPositioned::HELIPORT:
+
+ break;
+
+ case FGPositioned::RUNWAY: {
+ FGRunway* rwy = static_cast<FGRunway*>(pos);
+ nd->setDoubleValue("heading-deg", rwy->headingDeg());
+ nd->setIntValue("length-ft", rwy->lengthFt());
+ nd->setStringValue("airport", rwy->airport()->ident());
+ break;
+ }
+
+ default:
+ break;
+ }
+}
+
+void NavDisplay::computePositionedState(FGPositioned* pos, string_set& states)
+{
+ if (_routeSources.count(pos) != 0) {
+ states.insert("on-active-route");
+ }
+
+ switch (pos->type()) {
+ case FGPositioned::VOR:
+ case FGPositioned::LOC:
+ if (pos == _nav1Station) {
+ states.insert("tuned");
+ states.insert("nav1");
}
- else
- if (altDif<0)
- {
- sign='-';
- altDif = -altDif;
- dy=-30;
+
+ if (pos == _nav2Station) {
+ states.insert("tuned");
+ states.insert("nav2");
}
- 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;
+ 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 == _route->departureAirport()) {
+ states.insert("departure");
}
- else // relative altitude display
- if (sign)
- {
- text << sign
- << setprecision(0) << fixed
- << setw(2) << setfill('0') << altDif << endl;
+
+ if (pos == _route->destinationAirport()) {
+ states.insert("destination");
}
+ break;
- 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::RUNWAY:
+ if (pos == _route->departureRunway()) {
+ states.insert("departure");
+ }
+
+ if (pos == _route->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
}
-void
-NavDisplay::updateFont()
+void NavDisplay::processAI()
{
- 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);
+ 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);
+ SymbolDefVector rules;
+ findRules(string("ai-") + model->getName(), ss, rules);
+ if (rules.empty()) {
+ return; // no rules matched, we can skip this item
+ }
- _font_size = _font_node->getFloatValue("size");
- _font_spacing = _font_size * _font_node->getFloatValue("line-spacing");
- string path = _font_node->getStringValue("name", DEFAULT_FONT);
+ 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(SymbolDef* r, rules) {
+ addSymbolInstance(projected, heading, r, (SGPropertyNode*) model);
+ }
+ } // of ai models iteration
+}
- SGPath tpath;
- if (path[0] != '/') {
- tpath = globals->get_fg_root();
- tpath.append("Fonts");
- tpath.append(path);
- } else {
- tpath = path;
+void NavDisplay::computeAIStates(const SGPropertyNode* ai, string_set& states)
+{
+ int threatLevel = ai->getIntValue("tcas/threat-level",-1);
+ if (threatLevel >= 0) {
+ states.insert("tcas");
+ // states.insert("tcas-threat-level-" + itoa(threatLevel));
}
-
-#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
-
- if (font != 0) {
- _font = font;
- _font->setMinFilterHint(osg::Texture::NEAREST);
- _font->setMagFilterHint(osg::Texture::NEAREST);
- _font->setGlyphImageMargin(0);
- _font->setGlyphImageMarginRatio(0);
+
+ 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);
- }
+void NavDisplay::addSymbolInstance(const osg::Vec2& proj, double heading, SymbolDef* def, SGPropertyNode* vars)
+{
+ SymbolInstance* sym = new SymbolInstance(proj, heading, def, vars);
+ _symbols.push_back(sym);
}
+
projects / flightgear.git / blobdiff