// kln89_page_*.[ch]xx - this file is one of the "pages" that // are used in the KLN89 GPS unit simulation. // // Written by David Luff, started 2005. // // Copyright (C) 2005 - David C Luff - david.luff@nottingham.ac.uk // // This program is free software; you can redistribute it and/or // modify it under the terms of the GNU General Public License as // published by the Free Software Foundation; either version 2 of the // License, or (at your option) any later version. // // This program is distributed in the hope that it will be useful, but // WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU // General Public License for more details. // // You should have received a copy of the GNU General Public License // along with this program; if not, write to the Free Software // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. // // $Id$ #ifdef HAVE_CONFIG_H # include "config.h" #endif #include "kln89_page_nav.hxx" #include
KLN89NavPage::KLN89NavPage(KLN89* parent) : KLN89Page(parent) { _nSubPages = 4; _subPage = 0; _name = "NAV"; _posFormat = 0; // Check - should this default to ref from waypoint? _vnv = 0; _nav4DataSnippet = 0; _cdiFormat = 0; _menuActive = false; _menuPos = 0; _suspendAVS = false; _scanWpSet = false; _scanWpIndex = -1; } KLN89NavPage::~KLN89NavPage() { } void KLN89NavPage::Update(double dt) { GPSFlightPlan* fp = _kln89->_activeFP; GPSWaypoint* awp = _kln89->GetActiveWaypoint(); // Scan-pull out on nav4 page switches off the cursor if(3 == _subPage && fgGetBool("/instrumentation/kln89/scan-pull")) { _kln89->_mode = KLN89_MODE_DISP; } bool crsr = (_kln89->_mode == KLN89_MODE_CRSR); bool blink = _kln89->_blink; double lat = _kln89->_gpsLat * SG_RADIANS_TO_DEGREES; double lon = _kln89->_gpsLon * SG_RADIANS_TO_DEGREES; if(_subPage != 3) { _scanWpSet = false; } if(0 == _subPage) { if(_kln89->_navFlagged) { _kln89->DrawText("> F L A G", 2, 0, 2); _kln89->DrawText("DTK --- TK ---", 2, 0, 1); _kln89->DrawText(">--- To --:--", 2, 0, 0); _kln89->DrawSpecialChar(0, 2, 7, 1); _kln89->DrawSpecialChar(0, 2, 15, 1); _kln89->DrawSpecialChar(0, 2, 4, 0); _kln89->DrawSpecialChar(1, 2, 3, 2); _kln89->DrawSpecialChar(1, 2, 4, 2); _kln89->DrawSpecialChar(1, 2, 6, 2); _kln89->DrawSpecialChar(1, 2, 10, 2); _kln89->DrawSpecialChar(1, 2, 12, 2); _kln89->DrawSpecialChar(1, 2, 13, 2); } else { if(_kln89->_dto) { _kln89->DrawDTO(2, 7, 3); } else { if(!(_kln89->_waypointAlert && _kln89->_blink)) { _kln89->DrawSpecialChar(3, 2, 8, 3); } } _kln89->DrawText(awp->id, 2, 10, 3); if(!_kln89->_dto && !_kln89->_obsMode && !_kln89->_fromWaypoint.id.empty()) { _kln89->DrawText(_kln89->_fromWaypoint.id, 2, 1, 3); } if(!(crsr && blink && _uLinePos == 1)) { if(_cdiFormat == 0) { _kln89->DrawCDI(); } else if(_cdiFormat == 1) { _kln89->DrawText("Fly", 2, 2, 2); double x = _kln89->CalcCrossTrackDeviation(); // TODO - check the R/L from sign of x below - I *think* it holds but not sure! // Note also that we're setting Fly R or L based on the aircraft // position only, not the heading. Not sure if this is correct or not. _kln89->DrawText(x < 0.0 ? "R" : "L", 2, 6, 2); char buf[6]; int n; x = fabs(x * (_kln89->_distUnits == GPS_DIST_UNITS_NM ? 1.0 : SG_NM_TO_METER * 0.001)); if(x < 1.0) { n = snprintf(buf, 6, "%0.2f", x); } else if(x < 100.0) { n = snprintf(buf, 6, "%0.1f", x); } else { n = snprintf(buf, 6, "%i", (int)(x+0.5)); } _kln89->DrawText((string)buf, 2, 13-n, 2); _kln89->DrawText(_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "km", 2, 13, 2); } else { _kln89->DrawText("CDI Scale:", 2, 1, 2); double d = _kln89->_cdiScales[_kln89->_currentCdiScaleIndex] * (_kln89->_distUnits == GPS_DIST_UNITS_NM ? 1.0 : SG_NM_TO_METER * 0.001); char buf[5]; string s; if(d >= 1.0) { snprintf(buf, 4, "%2.1f", d); s = buf; } else { snprintf(buf, 5, "%2.2f", d); // trim the leading zero s = buf; s = s.substr(1, s.size() - 1); } _kln89->DrawText(s, 2, 11, 2); _kln89->DrawText(_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "km", 2, 14, 2); } } _kln89->DrawChar('>', 2, 0, 2); _kln89->DrawChar('>', 2, 0, 0); if(crsr) { if(_uLinePos == 1) _kln89->Underline(2, 1, 2, 15); else if(_uLinePos == 2) _kln89->Underline(2, 1, 0, 9); } // Desired and actual magnetic track if(!_kln89->_obsMode) { _kln89->DrawText("DTK", 2, 0, 1); _kln89->DrawHeading((int)_kln89->_dtkMag, 2, 7, 1); } _kln89->DrawText("TK", 2, 9, 1); if(_kln89->_groundSpeed_ms > 3) { // about 6 knots, don't know exactly what value to disable track // The trouble with relying on FG gps's track value is we don't know when it's valid. _kln89->DrawHeading((int)_kln89->_magTrackDeg, 2, 15, 1); } else { _kln89->DrawText("---", 2, 12, 1); _kln89->DrawSpecialChar(0, 2, 15, 1); } // Radial to/from active waypoint. // TODO - Not sure if this either is or should be true or mag!!!!!!! if(!(crsr && blink && _uLinePos == 2)) { if(0 == _vnv) { _kln89->DrawHeading((int)_kln89->GetHeadingToActiveWaypoint(), 2, 4, 0); _kln89->DrawText("To", 2, 5, 0); } else if(1 == _vnv) { _kln89->DrawHeading((int)_kln89->GetHeadingFromActiveWaypoint(), 2, 4, 0); _kln89->DrawText("Fr", 2, 5, 0); } else { _kln89->DrawText("Vnv Off", 2, 1, 0); } } // It seems that the floating point groundspeed must be at least 30kt // for an ETA to be calculated. Note that this means that (integer) 30kt // can appear in the frame 1 display both with and without an ETA displayed. // TODO - need to switch off track (and heading bug change) based on instantaneous speed as well // since the long gps lag filter means we can still be displaying when stopped on ground. if(_kln89->_groundSpeed_kts > 30.0) { // Assuming eta display is always hh:mm // Does it ever switch to seconds when close? if(_kln89->_eta / 3600.0 > 100.0) { // More that 100 hours ! - Doesn't fit. _kln89->DrawText("--:--", 2, 11, 0); } else { _kln89->DrawTime(_kln89->_eta, 2, 15, 0); } } else { _kln89->DrawText("--:--", 2, 11, 0); } } } else if(1 == _subPage) { // Present position _kln89->DrawChar('>', 2, 1, 3); if(!(crsr && blink && _uLinePos == 1)) _kln89->DrawText("PRESENT POSN", 2, 2, 3); if(crsr && _uLinePos == 1) _kln89->Underline(2, 2, 3, 12); if(0 == _posFormat) { // Lat/lon _kln89->DrawLatitude(lat, 2, 3, 1); _kln89->DrawLongitude(lon, 2, 3, 0); } else { // Ref from wp - defaults to nearest vor (and resets to default when page left and re-entered). } } else if(2 == _subPage) { _kln89->DrawText("Time", 2, 0, 3); // TODO - hardwired to UTC at the moment _kln89->DrawText("UTC", 2, 6, 3); string th = fgGetString("/instrumentation/clock/indicated-hour"); string tm = fgGetString("/instrumentation/clock/indicated-min"); if(th.size() == 1) th = "0" + th; if(tm.size() == 1) tm = "0" + tm; _kln89->DrawText(th + tm, 2, 11, 3); _kln89->DrawText("Depart", 2, 0, 2); _kln89->DrawText(_kln89->_departureTimeString, 2, 11, 2); _kln89->DrawText("ETA", 2, 0, 1); if(_kln89->_departed) { /* Rules of ETA waypoint are: If the active waypoint is part of the active flightplan, then display the ETA to the final (destination) waypoint of the active flightplan. If the active waypoint is not part of the active flightplan, then display the ETA to the active waypoint. */ // TODO - implement the above properly - we haven't below! string wid = ""; if(fp->waypoints.size()) { wid = fp->waypoints[fp->waypoints.size() - 1]->id; } else if(awp) { wid = awp->id; } if(!wid.empty()) { _kln89->DrawText(wid, 2, 4, 1); double tsec = _kln89->GetTimeToWaypoint(wid); if(tsec < 0.0) { _kln89->DrawText("----", 2, 11, 1); } else { int etah = (int)tsec / 3600; int etam = ((int)tsec - etah * 3600) / 60; etah += atoi(fgGetString("/instrumentation/clock/indicated-hour")); etam += atoi(fgGetString("/instrumentation/clock/indicated-min")); while(etam > 59) { etam -= 60; etah += 1; } while(etah > 23) { etah -= 24; } char buf[6]; int n = snprintf(buf, 6, "%02i%02i", etah, etam); _kln89->DrawText((string)buf, 2, 15-n, 1); } } else { _kln89->DrawText("----", 2, 11, 1); } } else { _kln89->DrawText("----", 2, 11, 1); } _kln89->DrawText("Flight", 2, 0, 0); if(_kln89->_departed) { int eh = (int)_kln89->_elapsedTime / 3600; int em = ((int)_kln89->_elapsedTime - eh * 3600) / 60; char buf[6]; int n = snprintf(buf, 6, "%i:%02i", eh, em); _kln89->DrawText((string)buf, 2, 15-n, 0); } else { _kln89->DrawText("-:--", 2, 11, 0); } } else { // if(3 == _subPage) // Switch the cursor off if scan-pull is out on this page. if(fgGetBool("/instrumentation/kln89/scan-pull")) { _kln89->_mode = KLN89_MODE_DISP; } // The moving map page the core KLN89 class draws this. if(_kln89->_mapOrientation == 2 && _kln89->_groundSpeed_kts < 2) { // Don't draw it if in track up mode and groundspeed < 2kts, as per real-life unit. } else { _kln89->DrawMap(!_suspendAVS); } // Now draw any annotation over it. int scale = KLN89MapScales[_kln89->_mapScaleUnits][_kln89->_mapScaleIndex]; string scle_str = GPSitoa(scale); if(crsr) { if(_menuActive) { // Draw a background quad to encompass on/off for the first three at 'off' length _kln89->DrawMapQuad(28, 9, 48, 36, true); _kln89->DrawMapText("SUA:", 1, 27, true); if(!(_menuPos == 0 && _kln89->_blink)) _kln89->DrawMapText((_kln89->_drawSUA ? "on" : "off"), 29, 27, true); if(_menuPos == 0) _kln89->DrawLine(28, 27, 48, 27); _kln89->DrawMapText("VOR:", 1, 18, true); if(!(_menuPos == 1 && _kln89->_blink)) _kln89->DrawMapText((_kln89->_drawVOR ? "on" : "off"), 29, 18, true); if(_menuPos == 1) _kln89->DrawLine(28, 18, 48, 18); _kln89->DrawMapText("APT:", 1, 9, true); if(!(_menuPos == 2 && _kln89->_blink)) _kln89->DrawMapText((_kln89->_drawApt ? "on" : "off"), 29, 9, true); if(_menuPos == 2) _kln89->DrawLine(28, 9, 48, 9); _kln89->DrawMapQuad(0, 0, 27, 8, true); if(!(_menuPos == 3 && _kln89->_blink)) { if(_kln89->_mapOrientation == 0) { _kln89->DrawMapText("N", 1, 0, true); _kln89->DrawMapUpArrow(7, 1); } else if(_kln89->_mapOrientation == 1) { _kln89->DrawMapText("DTK", 1, 0, true); _kln89->DrawMapUpArrow(21, 1); } else { // Don't bother with heading up for now! _kln89->DrawMapText("TK", 1, 0, true); _kln89->DrawMapUpArrow(14, 1); } } if(_menuPos == 3) _kln89->DrawLine(0, 0, 27, 0); } else { if(_uLinePos == 2) { if(!_kln89->_blink) { _kln89->DrawMapText("Menu?", 1, 9, true); _kln89->DrawEnt(); _kln89->DrawLine(0, 9, 34, 9); } else { _kln89->DrawMapQuad(0, 9, 34, 17, true); } } else { _kln89->DrawMapText("Menu?", 1, 9, true); } // right-justify the scale when _uLinePos == 3 if(!(_uLinePos == 3 && _kln89->_blink)) _kln89->DrawMapText(scle_str, (_uLinePos == 3 ? 29 - (scle_str.size() * 7) : 1), 0, true); if(_uLinePos == 3) _kln89->DrawLine(0, 0, 27, 0); } } else { // Just draw the scale _kln89->DrawMapText(scle_str, 1, 0, true); } // If the scan-pull knob is out, draw one of the waypoints (if applicable). if(fgGetBool("/instrumentation/kln89/scan-pull")) { if(_kln89->_activeFP->waypoints.size()) { //cout << "Need to draw a waypoint!\n"; _kln89->DrawLine(70, 0, 111, 0); if(!_kln89->_blink) { //_kln89->DrawMapQuad(45, 0, 97, 8, true); if(!_scanWpSet) { _scanWpIndex = _kln89->GetActiveWaypointIndex(); _scanWpSet = true; } _kln89->DrawMapText(_kln89->_activeFP->waypoints[_scanWpIndex]->id, 71, 0, true); } } } // And do part of the field 1 update, since NAV 4 is a special case for the last line. _kln89->DrawChar('>', 1, 0, 0); if(crsr && _uLinePos == 1) _kln89->Underline(1, 1, 0, 5); if(!(crsr && _uLinePos == 1 && _kln89->_blink)) { if(_kln89->_obsMode && _nav4DataSnippet == 0) _nav4DataSnippet = 1; double tsec; switch(_nav4DataSnippet) { case 0: // DTK _kln89->DrawLabel("DTK", -39, 6); // TODO - check we have an active FP / dtk and draw dashes if not. char buf0[4]; snprintf(buf0, 4, "%03i", (int)(_kln89->_dtkMag)); _kln89->DrawText((string)buf0, 1, 3, 0); break; case 1: // groundspeed _kln89->DrawSpeed(_kln89->_groundSpeed_kts, 1, 5, 0); break; case 2: // ETE tsec = _kln89->GetETE(); if(tsec < 0.0) { _kln89->DrawText("--:--", 1, 1, 0); } else { int eteh = (int)tsec / 3600; int etem = ((int)tsec - eteh * 3600) / 60; char buf[6]; int n = snprintf(buf, 6, "%02i:%02i", eteh, etem); _kln89->DrawText((string)buf, 1, 6-n, 0); } break; case 3: // Cross-track correction double x = _kln89->CalcCrossTrackDeviation(); if(x < 0.0) { _kln89->DrawSpecialChar(3, 1, 5, 0); } else { _kln89->DrawSpecialChar(7, 1, 5, 0); } char buf3[6]; int n; x = fabs(x * (_kln89->_distUnits == GPS_DIST_UNITS_NM ? 1.0 : SG_NM_TO_METER * 0.001)); if(x < 1.0) { n = snprintf(buf3, 6, "%0.2f", x); } else if(x < 100.0) { n = snprintf(buf3, 6, "%0.1f", x); } else { n = snprintf(buf3, 6, "%i", (int)(x+0.5)); } _kln89->DrawText((string)buf3, 1, 5-n, 0); break; } } } KLN89Page::Update(dt); } // Returns the id string of the selected waypoint on NAV4 if valid, else returns an empty string. string KLN89NavPage::GetNav4WpId() { if(3 == _subPage) { if(fgGetBool("/instrumentation/kln89/scan-pull")) { if(_kln89->_activeFP->waypoints.size()) { if(!_scanWpSet) { return(_kln89->_activeWaypoint.id); } else { return(_kln89->_activeFP->waypoints[_scanWpIndex]->id); } } } } return(""); } void KLN89NavPage::LooseFocus() { _suspendAVS = false; _scanWpSet = false; } void KLN89NavPage::CrsrPressed() { if(_kln89->_mode == KLN89_MODE_DISP) { // Crsr just switched off _menuActive = false; } else { // Crsr just switched on if(_subPage < 3) { _uLinePos = 1; } else { _uLinePos = 3; } } } void KLN89NavPage::EntPressed() { if(_kln89->_mode == KLN89_MODE_CRSR) { if(_subPage == 3 && _uLinePos == 2 && !_menuActive) { _menuActive = true; _menuPos = 0; _suspendAVS = false; } } } void KLN89NavPage::ClrPressed() { if(_kln89->_mode == KLN89_MODE_CRSR) { if(_subPage == 0) { if(_uLinePos == 1) { _cdiFormat++; if(_cdiFormat > 2) _cdiFormat = 0; } else if(_uLinePos == 2) { _vnv++; if(_vnv > 2) _vnv = 0; } } if(_subPage == 3) { if(_uLinePos > 1) { _suspendAVS = !_suspendAVS; _menuActive = false; } else if(_uLinePos == 1) { _nav4DataSnippet++; if(_nav4DataSnippet > 3) _nav4DataSnippet = 0; } } } else { if(_subPage == 3) { _suspendAVS = !_suspendAVS; } } } void KLN89NavPage::Knob1Left1() { if(_kln89->_mode == KLN89_MODE_CRSR) { if(!(_subPage == 3 && _menuActive)) { if(_uLinePos > 0) _uLinePos--; } else { if(_menuPos > 0) _menuPos--; } } } void KLN89NavPage::Knob1Right1() { if(_kln89->_mode == KLN89_MODE_CRSR) { if(_subPage < 2) { if(_uLinePos < 2) _uLinePos++; } else if(_subPage == 2) { _uLinePos = 1; } else { // NAV 4 - this is complicated by whether the menu is displayed or not. if(_menuActive) { if(_menuPos < 3) _menuPos++; } else { if(_uLinePos < 3) _uLinePos++; } } } } void KLN89NavPage::Knob2Left1() { // If the inner-knob is out on the nav4 page, the only effect is to cycle the displayed waypoint. if(3 == _subPage && fgGetBool("/instrumentation/kln89/scan-pull")) { if(_kln89->_activeFP->waypoints.size()) { // TODO - find out what happens when scan-pull is on on nav4 without an active FP. // It's unlikely that we could get here without _scanWpSet, but theoretically possible, so we need to cover it. if(!_scanWpSet) { _scanWpIndex = _kln89->GetActiveWaypointIndex(); _scanWpSet = true; } else { if(0 == _scanWpIndex) { _scanWpIndex = _kln89->_activeFP->waypoints.size() - 1; } else { _scanWpIndex--; } } } return; } if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) { KLN89Page::Knob2Left1(); return; } if(_subPage == 0) { if(_uLinePos == 1 && _cdiFormat == 2) { _kln89->CDIFSDIncrease(); } } else if(_subPage == 3) { if(_menuActive) { if(_menuPos == 0) { _kln89->_drawSUA = !_kln89->_drawSUA; } else if(_menuPos == 1) { _kln89->_drawVOR = !_kln89->_drawVOR; } else if(_menuPos == 2) { _kln89->_drawApt = !_kln89->_drawApt; } else { if(_kln89->_mapOrientation == 0) { // Don't allow heading up for now _kln89->_mapOrientation = 2; } else { _kln89->_mapOrientation--; } _kln89->UpdateMapHeading(); } } else if(_uLinePos == 3) { // TODO - add AUTO if(_kln89->_mapScaleIndex == 0) { _kln89->_mapScaleIndex = 20; } else { _kln89->_mapScaleIndex--; } } } } void KLN89NavPage::Knob2Right1() { // If the inner-knob is out on the nav4 page, the only effect is to cycle the displayed waypoint. if(3 == _subPage && fgGetBool("/instrumentation/kln89/scan-pull")) { if(_kln89->_activeFP->waypoints.size()) { // TODO - find out what happens when scan-pull is on on nav4 without an active FP. // It's unlikely that we could get here without _scanWpSet, but theoretically possible, so we need to cover it. if(!_scanWpSet) { _scanWpIndex = _kln89->GetActiveWaypointIndex(); _scanWpSet = true; } else { _scanWpIndex++; if(_scanWpIndex > static_cast(_kln89->_activeFP->waypoints.size()) - 1) { _scanWpIndex = 0; } } } return; } if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) { KLN89Page::Knob2Right1(); return; } if(_subPage == 0) { if(_uLinePos == 1 && _cdiFormat == 2) { _kln89->CDIFSDDecrease(); } } else if(_subPage == 3) { if(_menuActive) { if(_menuPos == 0) { _kln89->_drawSUA = !_kln89->_drawSUA; } else if(_menuPos == 1) { _kln89->_drawVOR = !_kln89->_drawVOR; } else if(_menuPos == 2) { _kln89->_drawApt = !_kln89->_drawApt; } else { if(_kln89->_mapOrientation >= 2) { // Don't allow heading up for now _kln89->_mapOrientation = 0; } else { _kln89->_mapOrientation++; } _kln89->UpdateMapHeading(); } } else if(_uLinePos == 3) { // TODO - add AUTO if(_kln89->_mapScaleIndex == 20) { _kln89->_mapScaleIndex = 0; } else { _kln89->_mapScaleIndex++; } } } }