src/Instrumentation/KLN89/kln89_page_int.cxx

   1 // kln89_page_*.[ch]xx - this file is one of the "pages" that
   2 //                       are used in the KLN89 GPS unit simulation.
   3 //
   4 // Written by David Luff, started 2005.
   5 //
   6 // Copyright (C) 2005 - David C Luff - david.luff@nottingham.ac.uk
   7 //
   8 // This program is free software; you can redistribute it and/or
   9 // modify it under the terms of the GNU General Public License as
  10 // published by the Free Software Foundation; either version 2 of the
  11 // License, or (at your option) any later version.
  12 //
  13 // This program is distributed in the hope that it will be useful, but
  14 // WITHOUT ANY WARRANTY; without even the implied warranty of
  15 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16 // General Public License for more details.
  17 //
  18 // You should have received a copy of the GNU General Public License
  19 // along with this program; if not, write to the Free Software
  20 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
  21 //
  22 // $Id$
  23
  24 #ifdef HAVE_CONFIG_H
  25 #  include "config.h"
  26 #endif
  27
  28 #include "kln89_page_int.hxx"
  29 #include "Navaids/fix.hxx"
  30
  31 KLN89IntPage::KLN89IntPage(KLN89* parent)
  32 : KLN89Page(parent) {
  33         _nSubPages = 2;
  34         _subPage = 0;
  35         _name = "INT";
  36         _int_id = "PORTE";
  37         _last_int_id = "";
  38         _fp = NULL;
  39         _nearestVor = NULL;
  40         _refNav = NULL;
  41 }
  42
  43 KLN89IntPage::~KLN89IntPage() {
  44 }
  45
  46 void KLN89IntPage::Update(double dt) {
  47         bool actPage = (_kln89->_activePage->GetName() == "ACT" ? true : false);
  48         bool multi;  // Not set by FindFirst...
  49         bool exact = false;
  50         if(_int_id.size() == 5) exact = true;
  51         if(_fp == NULL) {
  52                 _fp = _kln89->FindFirstIntById(_int_id, multi, exact);
  53         } else if(_fp->get_ident() != _int_id) {
  54                 _fp = _kln89->FindFirstIntById(_int_id, multi, exact);
  55         }
  56
  57         if(_fp) {
  58                 _int_id = _fp->get_ident();
  59                 if(_kln89->GetActiveWaypoint()) {
  60                         if(_int_id == _kln89->GetActiveWaypoint()->id) {
  61                                 if(!(_kln89->_waypointAlert && _kln89->_blink)) {
  62                                         // Active waypoint arrow
  63                                         _kln89->DrawSpecialChar(4, 2, 0, 3);
  64                                 }
  65                         }
  66                 }
  67                 if(_int_id != _last_int_id) {
  68                         _nearestVor = _kln89->FindClosestVor(_fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
  69                         if(_nearestVor) {
  70                                 _nvRadial = _kln89->GetMagHeadingFromTo(_nearestVor->get_lat() * SG_DEGREES_TO_RADIANS, _nearestVor->get_lon() * SG_DEGREES_TO_RADIANS,
  71                                                                     _fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
  72                                 _nvDist = _kln89->GetGreatCircleDistance(_nearestVor->get_lat() * SG_DEGREES_TO_RADIANS, _nearestVor->get_lon() * SG_DEGREES_TO_RADIANS,
  73                                                                      _fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
  74                                 _refNav = _nearestVor;  // TODO - check that this *always* holds - eg. when changing INT id after explicitly setting ref nav
  75                                                                         // but with no loss of focus.
  76                         } else {
  77                                 _refNav = NULL;
  78                         }
  79                         _last_int_id = _int_id;
  80                 }
  81                 if(_kln89->_mode != KLN89_MODE_CRSR) {
  82                         if(!_entInvert) {
  83                                 if(!actPage) {
  84                                         _kln89->DrawText(_fp->get_ident(), 2, 1, 3);
  85                                 } else {
  86                                         // If it's the ACT page, The ID is shifted slightly right to make space for the waypoint index.
  87                                         _kln89->DrawText(_fp->get_ident(), 2, 4, 3);
  88                                         char buf[3];
  89                                         int n = snprintf(buf, 3, "%i", _kln89->GetActiveWaypointIndex() + 1);
  90                                         _kln89->DrawText((string)buf, 2, 3 - n, 3);
  91                                         // We also draw an I to differentiate INT from USR when it's the ACT page
  92                                         _kln89->DrawText("I", 2, 11, 3);
  93                                 }
  94                         } else {
  95                                 if(!_kln89->_blink) {
  96                                         _kln89->DrawText(_fp->get_ident(), 2, 1, 3, false, 99);
  97                                         _kln89->DrawEnt();
  98                                 }
  99                         }
 100                 }
 101                 if(_subPage == 0) {
 102                         _kln89->DrawLatitude(_fp->get_lat(), 2, 3, 2);
 103                         _kln89->DrawLongitude(_fp->get_lon(), 2, 3, 1);
 104                         _kln89->DrawDirDistField(_fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS, 2, 0, 0,
 105                                                  _to_flag, (_kln89->_mode == KLN89_MODE_CRSR && _uLinePos == 6 ? true : false));
 106                 } else {
 107                         _kln89->DrawText("Ref:", 2, 1, 2);
 108                         _kln89->DrawText("Rad:", 2, 1, 1);
 109                         _kln89->DrawText("Dis:", 2, 1, 0);
 110                         if(_refNav) {
 111                                 _kln89->DrawText(_refNav->get_ident(), 2, 9, 2);        // TODO - flash and allow to change if under cursor
 112                                 //_kln89->DrawHeading(_nvRadial, 2, 11, 1);
 113                                 //_kln89->DrawDist(_nvDist, 2, 11, 0);
 114                                 // Currently our draw heading and draw dist functions don't do as many decimal points as we want here,
 115                                 // so draw it ourselves!
 116                                 // Heading
 117                                 char buf[10];
 118                                 snprintf(buf, 6, "%.1f", _nvRadial);
 119                                 string s = buf;
 120                                 _kln89->DrawText(s, 2, 13 - s.size(), 1);
 121                                 _kln89->DrawSpecialChar(0, 2, 13, 1);   // Degrees symbol
 122                                 // Dist
 123                                 double d = _nvDist;
 124                                 d *= (_kln89->_distUnits == GPS_DIST_UNITS_NM ? 1.0 : SG_NM_TO_METER * 0.001);
 125                                 snprintf(buf, 9, "%.1f", d);
 126                                 s = buf;
 127                                 s += (_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "Km");
 128                                 _kln89->DrawText(s, 2, 14 - s.size(), 0);
 129                         }
 130                 }
 131         } else {
 132                 // TODO - when we leave the page with invalid id and return it should
 133                 // revert to showing the last valid id.  Same for vor/ndb/probably apt etc.
 134                 if(_kln89->_mode != KLN89_MODE_CRSR) _kln89->DrawText(_int_id, 2, 1, 3);
 135                 if(_subPage == 0) {
 136                         _kln89->DrawText("- -- --.--'", 2, 3, 2);
 137                         _kln89->DrawText("---- --.--'", 2, 3, 1);
 138                         _kln89->DrawSpecialChar(0, 2, 7, 2);
 139                         _kln89->DrawSpecialChar(0, 2, 7, 1);
 140                         _kln89->DrawText(">---    ----", 2, 0, 0);
 141                         _kln89->DrawSpecialChar(0, 2, 4, 0);
 142                         _kln89->DrawText(_to_flag ? "To" : "Fr", 2, 5, 0);
 143                         _kln89->DrawText(_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "km", 2, 12, 0);
 144                 }
 145         }
 146
 147         if(_kln89->_mode == KLN89_MODE_CRSR) {
 148                 if(_uLinePos > 0 && _uLinePos < 6) {
 149                         // TODO - blink as well
 150                         _kln89->Underline(2, _uLinePos, 3, 1);
 151                 }
 152                 for(unsigned int i = 0; i < _int_id.size(); ++i) {
 153                         if(_uLinePos != (i + 1)) {
 154                                 _kln89->DrawChar(_int_id[i], 2, i + 1, 3);
 155                         } else {
 156                                 if(!_kln89->_blink) _kln89->DrawChar(_int_id[i], 2, i + 1, 3);
 157                         }
 158                 }
 159         }
 160
 161         // TODO - fix this duplication - use _id instead of _apt_id, _vor_id, _ndb_id, _int_id etc!
 162         _id = _int_id;
 163
 164         KLN89Page::Update(dt);
 165 }
 166
 167 void KLN89IntPage::SetId(const string& s) {
 168         _last_int_id = _int_id;
 169         _save_int_id = _int_id;
 170         _int_id = s;
 171         _fp = NULL;
 172 }
 173
 174 void KLN89IntPage::CrsrPressed() {
 175         if(_kln89->_mode == KLN89_MODE_DISP) return;
 176         if(_kln89->_obsMode) {
 177                 _uLinePos = 0;
 178         } else {
 179                 _uLinePos = 1;
 180         }
 181         if(_subPage == 0) {
 182                 _maxULinePos = 6;
 183         } else {
 184                 _maxULinePos = 6;
 185         }
 186 }
 187
 188 void KLN89IntPage::ClrPressed() {
 189         if(_subPage == 0 && _uLinePos == 6) {
 190                 _to_flag = !_to_flag;
 191         }
 192 }
 193
 194 void KLN89IntPage::EntPressed() {
 195         if(_entInvert) {
 196                 _entInvert = false;
 197                 _last_int_id = _int_id;
 198                 _int_id = _save_int_id;
 199         }
 200 }
 201
 202 void KLN89IntPage::Knob2Left1() {
 203         if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) {
 204                 KLN89Page::Knob2Left1();
 205         } else {
 206                 if(_uLinePos < 6) {
 207                         // Same logic for both pages - set the ID
 208                         _int_id = _int_id.substr(0, _uLinePos);
 209                         // ASSERT(_uLinePos > 0);
 210                         if(_uLinePos == (_int_id.size() + 1)) {
 211                                 _int_id += '9';
 212                         } else {
 213                                 _int_id[_uLinePos - 1] = _kln89->DecChar(_int_id[_uLinePos - 1], (_uLinePos == 1 ? false : true));
 214                         }
 215                 } else {
 216                         if(_subPage == 0) {
 217                                 // NO-OP - from/to field is switched by clr button, not inner knob.
 218                         } else {
 219                                 // TODO - LNR type field.
 220                         }
 221                 }
 222         }
 223 }
 224
 225 void KLN89IntPage::Knob2Right1() {
 226         if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) {
 227                 KLN89Page::Knob2Right1();
 228         } else {
 229                 if(_uLinePos < 6) {
 230                         // Same logic for both pages - set the ID
 231                         _int_id = _int_id.substr(0, _uLinePos);
 232                         // ASSERT(_uLinePos > 0);
 233                         if(_uLinePos == (_int_id.size() + 1)) {
 234                                 _int_id += 'A';
 235                         } else {
 236                                 _int_id[_uLinePos - 1] = _kln89->IncChar(_int_id[_uLinePos - 1], (_uLinePos == 1 ? false : true));
 237                         }
 238                 } else {
 239                         if(_subPage == 0) {
 240                                 // NO-OP - from/to field is switched by clr button, not inner knob.
 241                         } else {
 242                                 // TODO - LNR type field.
 243                         }
 244                 }
 245         }
 246 }
 247