]> git.mxchange.org Git - flightgear.git/blob - src/Instrumentation/KLN89/kln89_page_int.cxx
Make traffic take-off roll look a little better.
[flightgear.git] / 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 - daveluff AT ntlworld.com
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 #include <Navaids/navrecord.hxx>
31
32 using std::string;
33
34 KLN89IntPage::KLN89IntPage(KLN89* parent) 
35 : KLN89Page(parent) {
36         _nSubPages = 2;
37         _subPage = 0;
38         _name = "INT";
39         _int_id = "PORTE";
40         _last_int_id = "";
41         _fp = NULL;
42         _nearestVor = NULL;
43         _refNav = NULL;
44 }
45
46 KLN89IntPage::~KLN89IntPage() {
47 }
48
49 void KLN89IntPage::Update(double dt) {
50         bool actPage = (_kln89->_activePage->GetName() == "ACT" ? true : false);
51         bool multi;  // Not set by FindFirst...
52         bool exact = false;
53         if(_int_id.size() == 5) exact = true;
54         if(_fp == NULL) {
55                 _fp = _kln89->FindFirstIntById(_int_id, multi, exact);
56         } else if(_fp->get_ident() != _int_id) {
57                 _fp = _kln89->FindFirstIntById(_int_id, multi, exact);
58         }
59         
60         if(_fp) {
61                 _int_id = _fp->get_ident();
62                 if(_kln89->GetActiveWaypoint()) {
63                         if(_int_id == _kln89->GetActiveWaypoint()->id) {
64                                 if(!(_kln89->_waypointAlert && _kln89->_blink)) {
65                                         // Active waypoint arrow
66                                         _kln89->DrawSpecialChar(4, 2, 0, 3);
67                                 }
68                         }
69                 }
70                 if(_int_id != _last_int_id) {
71                         _nearestVor = _kln89->FindClosestVor(_fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
72                         if(_nearestVor) {
73                                 _nvRadial = _kln89->GetMagHeadingFromTo(_nearestVor->get_lat() * SG_DEGREES_TO_RADIANS, _nearestVor->get_lon() * SG_DEGREES_TO_RADIANS,
74                                                                     _fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
75                                 _nvDist = _kln89->GetGreatCircleDistance(_nearestVor->get_lat() * SG_DEGREES_TO_RADIANS, _nearestVor->get_lon() * SG_DEGREES_TO_RADIANS,
76                                                                      _fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS);
77                                 _refNav = _nearestVor;  // TODO - check that this *always* holds - eg. when changing INT id after explicitly setting ref nav 
78                                                                         // but with no loss of focus.
79                         } else {
80                                 _refNav = NULL;
81                         }
82                         _last_int_id = _int_id;
83                 }
84                 if(_kln89->_mode != KLN89_MODE_CRSR) {
85                         if(!_entInvert) {
86                                 if(!actPage) {
87                                         _kln89->DrawText(_fp->get_ident(), 2, 1, 3);
88                                 } else {
89                                         // If it's the ACT page, The ID is shifted slightly right to make space for the waypoint index.
90                                         _kln89->DrawText(_fp->get_ident(), 2, 4, 3);
91                                         char buf[3];
92                                         int n = snprintf(buf, 3, "%i", _kln89->GetActiveWaypointIndex() + 1);
93                                         _kln89->DrawText((string)buf, 2, 3 - n, 3);
94                                         // We also draw an I to differentiate INT from USR when it's the ACT page
95                                         _kln89->DrawText("I", 2, 11, 3);
96                                 }
97                         } else {
98                                 if(!_kln89->_blink) {
99                                         _kln89->DrawText(_fp->get_ident(), 2, 1, 3, false, 99);
100                                         _kln89->DrawEnt();
101                                 }
102                         }
103                 }
104                 if(_subPage == 0) {
105                         _kln89->DrawLatitude(_fp->get_lat(), 2, 3, 2);
106                         _kln89->DrawLongitude(_fp->get_lon(), 2, 3, 1);
107                         _kln89->DrawDirDistField(_fp->get_lat() * SG_DEGREES_TO_RADIANS, _fp->get_lon() * SG_DEGREES_TO_RADIANS, 2, 0, 0, 
108                                                  _to_flag, (_kln89->_mode == KLN89_MODE_CRSR && _uLinePos == 6 ? true : false));
109                 } else {
110                         _kln89->DrawText("Ref:", 2, 1, 2);
111                         _kln89->DrawText("Rad:", 2, 1, 1);
112                         _kln89->DrawText("Dis:", 2, 1, 0);
113                         if(_refNav) {
114                                 _kln89->DrawText(_refNav->get_ident(), 2, 9, 2);        // TODO - flash and allow to change if under cursor
115                                 //_kln89->DrawHeading(_nvRadial, 2, 11, 1);
116                                 //_kln89->DrawDist(_nvDist, 2, 11, 0);
117                                 // Currently our draw heading and draw dist functions don't do as many decimal points as we want here,
118                                 // so draw it ourselves!
119                                 // Heading
120                                 char buf[10];
121                                 snprintf(buf, 6, "%.1f", _nvRadial);
122                                 string s = buf;
123                                 _kln89->DrawText(s, 2, 13 - s.size(), 1);
124                                 _kln89->DrawSpecialChar(0, 2, 13, 1);   // Degrees symbol
125                                 // Dist
126                                 double d = _nvDist;
127                                 d *= (_kln89->_distUnits == GPS_DIST_UNITS_NM ? 1.0 : SG_NM_TO_METER * 0.001);
128                                 snprintf(buf, 9, "%.1f", d);
129                                 s = buf;
130                                 s += (_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "Km");
131                                 _kln89->DrawText(s, 2, 14 - s.size(), 0);
132                         }
133                 }
134         } else {
135                 // TODO - when we leave the page with invalid id and return it should
136                 // revert to showing the last valid id.  Same for vor/ndb/probably apt etc.
137                 if(_kln89->_mode != KLN89_MODE_CRSR) _kln89->DrawText(_int_id, 2, 1, 3);
138                 if(_subPage == 0) {
139                         _kln89->DrawText("- -- --.--'", 2, 3, 2);
140                         _kln89->DrawText("---- --.--'", 2, 3, 1);
141                         _kln89->DrawSpecialChar(0, 2, 7, 2);
142                         _kln89->DrawSpecialChar(0, 2, 7, 1);
143                         _kln89->DrawText(">---    ----", 2, 0, 0);
144                         _kln89->DrawSpecialChar(0, 2, 4, 0);
145                         _kln89->DrawText(_to_flag ? "To" : "Fr", 2, 5, 0);
146                         _kln89->DrawText(_kln89->_distUnits == GPS_DIST_UNITS_NM ? "nm" : "km", 2, 12, 0);
147                 }
148         }
149         
150         if(_kln89->_mode == KLN89_MODE_CRSR) {
151                 if(_uLinePos > 0 && _uLinePos < 6) {
152                         // TODO - blink as well
153                         _kln89->Underline(2, _uLinePos, 3, 1);
154                 }
155                 for(unsigned int i = 0; i < _int_id.size(); ++i) {
156                         if(_uLinePos != (i + 1)) {
157                                 _kln89->DrawChar(_int_id[i], 2, i + 1, 3);
158                         } else {
159                                 if(!_kln89->_blink) _kln89->DrawChar(_int_id[i], 2, i + 1, 3);
160                         }
161                 }
162         }
163         
164         // TODO - fix this duplication - use _id instead of _apt_id, _vor_id, _ndb_id, _int_id etc!
165         _id = _int_id;
166         
167         KLN89Page::Update(dt);
168 }
169
170 void KLN89IntPage::SetId(const string& s) {
171         _last_int_id = _int_id;
172         _save_int_id = _int_id;
173         _int_id = s;
174         _fp = NULL;
175 }
176
177 void KLN89IntPage::CrsrPressed() {
178         if(_kln89->_mode == KLN89_MODE_DISP) return;
179         if(_kln89->_obsMode) {
180                 _uLinePos = 0;
181         } else {
182                 _uLinePos = 1;
183         }
184         if(_subPage == 0) {
185                 _maxULinePos = 6;
186         } else {
187                 _maxULinePos = 6;
188         }
189 }
190
191 void KLN89IntPage::ClrPressed() {
192         if(_subPage == 0 && _uLinePos == 6) {
193                 _to_flag = !_to_flag;
194         }
195 }
196
197 void KLN89IntPage::EntPressed() {
198         if(_entInvert) {
199                 _entInvert = false;
200                 _entInvert = false;
201                 if(_kln89->_dtoReview) {
202                         _kln89->DtoInitiate(_int_id);
203                 } else {
204                         _last_int_id = _int_id;
205                         _int_id = _save_int_id;
206                 }
207         }
208 }
209
210 void KLN89IntPage::Knob2Left1() {
211         if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) {
212                 KLN89Page::Knob2Left1();
213         } else {
214                 if(_uLinePos < 6) {
215                         // Same logic for both pages - set the ID
216                         _int_id = _int_id.substr(0, _uLinePos);
217                         // ASSERT(_uLinePos > 0);
218                         if(_uLinePos == (_int_id.size() + 1)) {
219                                 _int_id += '9';
220                         } else {
221                                 _int_id[_uLinePos - 1] = _kln89->DecChar(_int_id[_uLinePos - 1], (_uLinePos == 1 ? false : true));
222                         }
223                 } else {
224                         if(_subPage == 0) {
225                                 // NO-OP - from/to field is switched by clr button, not inner knob.
226                         } else {
227                                 // TODO - LNR type field.
228                         }
229                 }
230         }
231 }
232
233 void KLN89IntPage::Knob2Right1() {
234         if(_kln89->_mode != KLN89_MODE_CRSR || _uLinePos == 0) {
235                 KLN89Page::Knob2Right1();
236         } else {
237                 if(_uLinePos < 6) {
238                         // Same logic for both pages - set the ID
239                         _int_id = _int_id.substr(0, _uLinePos);
240                         // ASSERT(_uLinePos > 0);
241                         if(_uLinePos == (_int_id.size() + 1)) {
242                                 _int_id += 'A';
243                         } else {
244                                 _int_id[_uLinePos - 1] = _kln89->IncChar(_int_id[_uLinePos - 1], (_uLinePos == 1 ? false : true));
245                         }
246                 } else {
247                         if(_subPage == 0) {
248                                 // NO-OP - from/to field is switched by clr button, not inner knob.
249                         } else {
250                                 // TODO - LNR type field.
251                         }
252                 }
253         }
254 }
255