1 // cockpit.cxx -- routines to draw a cockpit (initial draft)
3 // Written by Michele America, started September 1997.
5 // Copyright (C) 1997 Michele F. America - nomimarketing@mail.telepac.pt
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
38 #include <simgear/constants.h>
39 #include <simgear/debug/logstream.hxx>
40 #include <simgear/math/polar3d.hxx>
41 #include <simgear/props/props.hxx>
42 #include <simgear/timing/sg_time.hxx>
44 #include <Aircraft/aircraft.hxx>
45 #include <Include/general.hxx>
46 #include <FDM/ADA.hxx>
47 #include <Main/globals.hxx>
48 #include <Main/fg_props.hxx>
49 #include <Main/viewmgr.hxx>
50 #include <Scenery/scenery.hxx>
51 #include <Time/fg_timer.hxx>
54 #include "cockpit.hxx"
58 // This is a structure that contains all data related to
59 // cockpit/panel/hud system
61 static pCockpit ac_cockpit;
62 // The following routines obtain information concerntin the aircraft's
63 // current state and return it to calling instrument display routines.
64 // They should eventually be member functions of the aircraft.
67 float get_latitude( void )
69 return current_aircraft.fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES;
72 float get_lat_min( void )
76 a = current_aircraft.fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES;
80 d = (double) ( (int) a);
81 float lat_min = (a - d) * 60.0;
87 float get_longitude( void )
89 return current_aircraft.fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES;
94 get_formated_gmt_time( void )
97 const struct tm *p = globals->get_time_params()->getGmt();
98 sprintf( buf, "%d/%d/%4d %d:%02d:%02d",
99 p->tm_mon+1, p->tm_mday, 1900 + p->tm_year,
100 p->tm_hour, p->tm_min, p->tm_sec);
106 float get_long_min( void )
109 a = current_aircraft.fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES;
113 d = (double) ( (int) a);
114 float lon_min = (a - d) * 60.0;
119 float get_throttleval( void )
121 // Hack limiting to one engine
122 return globals->get_controls()->get_throttle( 0 );
125 float get_aileronval( void )
127 return globals->get_controls()->get_aileron();
130 float get_elevatorval( void )
132 return globals->get_controls()->get_elevator();
135 float get_elev_trimval( void )
137 return globals->get_controls()->get_elevator_trim();
140 float get_rudderval( void )
142 return globals->get_controls()->get_rudder();
145 float get_speed( void )
147 static const SGPropertyNode * speedup_node = fgGetNode("/sim/speed-up");
149 float speed = current_aircraft.fdm_state->get_V_calibrated_kts()
150 * speedup_node->getIntValue();
157 return current_aircraft.fdm_state->get_Mach_number();
160 float get_aoa( void )
162 return current_aircraft.fdm_state->get_Alpha() * SGD_RADIANS_TO_DEGREES;
165 float get_roll( void )
167 return current_aircraft.fdm_state->get_Phi();
170 float get_pitch( void )
172 return current_aircraft.fdm_state->get_Theta();
175 float get_heading( void )
177 return current_aircraft.fdm_state->get_Psi() * SGD_RADIANS_TO_DEGREES;
180 float get_altitude( void )
182 static const SGPropertyNode *startup_units_node
183 = fgGetNode("/sim/startup/units");
187 if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
188 altitude = current_aircraft.fdm_state->get_Altitude();
190 altitude = (current_aircraft.fdm_state->get_Altitude()
197 float get_agl( void )
199 static const SGPropertyNode *startup_units_node
200 = fgGetNode("/sim/startup/units");
204 if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
205 agl = (current_aircraft.fdm_state->get_Altitude()
206 - globals->get_scenery()->get_cur_elev() * SG_METER_TO_FEET);
208 agl = (current_aircraft.fdm_state->get_Altitude() * SG_FEET_TO_METER
209 - globals->get_scenery()->get_cur_elev());
215 float get_sideslip( void )
217 return current_aircraft.fdm_state->get_Beta();
220 float get_frame_rate( void )
222 return general.get_frame_rate();
225 float get_fov( void )
227 return globals->get_current_view()->get_fov();
230 float get_vfc_ratio( void )
232 // float vfc = current_view.get_vfc_ratio();
237 float get_vfc_tris_drawn ( void )
239 // float rendered = current_view.get_tris_rendered();
240 // return (rendered);
244 float get_vfc_tris_culled ( void )
246 // float culled = current_view.get_tris_culled();
251 float get_climb_rate( void )
253 static const SGPropertyNode *startup_units_node
254 = fgGetNode("/sim/startup/units");
257 if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
258 climb_rate = current_aircraft.fdm_state->get_Climb_Rate() * 60.0;
260 climb_rate = current_aircraft.fdm_state->get_Climb_Rate() * SG_FEET_TO_METER * 60.0;
267 float get_view_direction( void )
269 double view_off = SGD_2PI - globals->get_current_view()->getHeadingOffset_deg() * SGD_DEGREES_TO_RADIANS;
270 double view = ( current_aircraft.fdm_state->get_Psi() + view_off)
271 * SGD_RADIANS_TO_DEGREES;
281 // Added by Markus Hof on 5. Jan 2004
282 float get_dme( void )
284 static const SGPropertyNode * dme_node =
285 fgGetNode("/radios/dme/distance-nm");
287 return dme_node->getFloatValue();
290 // $$$ begin - added, VS Renganathan 13 Oct 2K
291 // #ifdef FIGHTER_HUD
292 float get_Vx ( void )
294 // Curt dont comment this and return zero. - Ranga
295 // Please remove comments from get_V_..() function in flight.hxx
296 float Vxx = current_aircraft.fdm_state->get_V_north_rel_ground();
300 float get_Vy ( void )
302 // Curt dont comment this and return zero. - Ranga
303 // Please remove comments from get_V_..() function in flight.hxx
304 float Vyy = current_aircraft.fdm_state->get_V_east_rel_ground();
308 float get_Vz ( void )
310 // Curt dont comment this and return zero. - Ranga
311 // Please remove comments from get_V_..() function in flight.hxx
312 float Vzz = current_aircraft.fdm_state->get_V_down_rel_ground();
316 float get_Ax ( void )
318 float Ax = current_aircraft.fdm_state->get_V_dot_north();
322 float get_Ay ( void )
324 float Ay = current_aircraft.fdm_state->get_V_dot_east();
328 float get_Az ( void )
330 float Az = current_aircraft.fdm_state->get_V_dot_down();
334 float get_anzg ( void )
336 float anzg = current_aircraft.fdm_state->get_N_Z_cg();
342 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
343 return fdm->get_iaux(1);
348 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
349 return fdm->get_iaux(2);
354 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
355 return fdm->get_iaux(3);
360 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
361 return fdm->get_iaux(4);
366 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
367 return fdm->get_iaux(5);
372 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
373 return fdm->get_iaux(6);
378 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
379 return fdm->get_iaux(7);
384 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
385 return fdm->get_iaux(8);
390 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
391 return fdm->get_iaux(9);
394 int get_iaux10 (void)
396 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
397 return fdm->get_iaux(10);
400 int get_iaux11 (void)
402 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
403 return fdm->get_iaux(11);
406 int get_iaux12 (void)
408 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
409 return fdm->get_iaux(12);
412 float get_aux1 (void)
414 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
415 return fdm->get_daux(1);
418 float get_aux2 (void)
420 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
421 return fdm->get_daux(2);
424 float get_aux3 (void)
426 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
427 return fdm->get_daux(3);
430 float get_aux4 (void)
432 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
433 return fdm->get_daux(4);
436 float get_aux5 (void)
438 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
439 return fdm->get_daux(5);
442 float get_aux6 (void)
444 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
445 return fdm->get_daux(6);
448 float get_aux7 (void)
450 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
451 return fdm->get_daux(7);
454 float get_aux8 (void)
456 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
457 return fdm->get_daux(8);
460 float get_aux9 (void)
462 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
463 return fdm->get_faux(1);
466 float get_aux10 (void)
468 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
469 return fdm->get_faux(2);
472 float get_aux11 (void)
474 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
475 return fdm->get_faux(3);
478 float get_aux12 (void)
480 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
481 return fdm->get_faux(4);
484 float get_aux13 (void)
486 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
487 return fdm->get_faux(5);
490 float get_aux14 (void)
492 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
493 return fdm->get_faux(6);
496 float get_aux15 (void)
498 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
499 return fdm->get_faux(7);
502 float get_aux16 (void)
504 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
505 return fdm->get_faux(8);
508 float get_aux17 (void)
510 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
511 return fdm->get_faux(9);
514 float get_aux18 (void)
516 FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
517 return fdm->get_faux(10);
520 // $$$ end - added, VS Renganathan 13 Oct 2K
524 /****************************************************************************/
525 /* Convert degrees to dd mm'ss.s" (DMS-Format) */
526 /****************************************************************************/
527 char *dmshh_format(double degrees)
538 min_part = 60.0 * (degrees - deg_part);
539 sec_part = 3600.0 * (degrees - deg_part - min_part / 60.0);
541 /* Round off hundredths */
542 if (sec_part + 0.005 >= 60.0)
543 sec_part -= 60.0, min_part += 1;
545 min_part -= 60, deg_part += 1;
547 sprintf(buf,"%02d*%02d %05.2f",deg_part,min_part,sec_part);
554 /************************************************************************
555 Convert degrees to dd mm.mmm' (DMM-Format)
556 Description: Converts using a round-off factor tailored to the required
557 precision of the minutes field (three decimal places). Round-off
558 prevents function from returning a minutes value of 60.
560 Input arguments: Coordinate value in decimal degrees
562 ************************************************************************/
563 static char *toDM(float dd)
574 /* round for minutes expressed to three decimal places */
575 tempdd = fabs(dd) + (5.0E-4 / 60.0);
577 mn = fabs( (tempdd - (double)(deg)) * 60.0 - 4.999E-4 );
579 sprintf(dm, "%d*%06.3f", deg, mn);
584 /************************************************************************
585 Convert degrees to dd mm'ss.s'' (DMS-Format)
586 Description: Converts using a round-off factor tailored to the required
587 precision of the seconds field (one decimal place). Round-off
588 prevents function from returning a seconds value of 60.
590 Input arguments: Coordinate value in decimal degrees
592 ************************************************************************/
593 static char *toDMS(float dd)
596 double tempdd, tempmin;
605 /* round up for seconds expressed to one decimal place */
606 tempdd = fabs(dd) + (0.05 / 3600.0);
608 tempmin = (tempdd - (double)(deg)) * 60.0;
610 sec = fabs( (tempmin - (double)(mn)) * 60.0 - 0.049 );
612 sprintf(dms, "%d*%02d %04.1f", deg, mn, sec);
617 // Have to set the LatLon display type
618 //static char *(*fgLatLonFormat)(float) = toDM;
619 static char *(*fgLatLonFormat)(float);
621 char *coord_format_lat(float latitude)
626 // dmshh_format(latitude),
629 fgLatLonFormat(latitude),
630 latitude > 0 ? 'N' : 'S');
634 char *coord_format_lon(float longitude)
639 // dmshh_format(longitude),
642 fgLatLonFormat(longitude),
643 longitude > 0 ? 'E' : 'W');
647 void fgLatLonFormatToggle( puObject *)
649 static int toggle = 0;
652 fgLatLonFormat = toDM;
654 fgLatLonFormat = toDMS;
660 char *coord_format_latlon(double latitude, double longitude)
662 static char buf[1024];
664 sprintf(buf,"%s%c %s%c",
665 dmshh_format(latitude),
666 latitude > 0 ? 'N' : 'S',
667 dmshh_format(longitude),
668 longitude > 0 ? 'E' : 'W');
674 bool fgCockpitInit( fgAIRCRAFT *cur_aircraft )
676 SG_LOG( SG_COCKPIT, SG_INFO, "Initializing cockpit subsystem" );
678 // cockpit->code = 1; /* It will be aircraft dependent */
679 // cockpit->status = 0;
681 // If aircraft has HUD specified we will get the specs from its def
682 // file. For now we will depend upon hard coding in hud?
684 // We must insure that the existing instrument link is purged.
685 // This is done by deleting the links in the list.
687 // HI_Head is now a null pointer so we can generate a new list from the
690 fgHUDInit( cur_aircraft );
691 ac_cockpit = new fg_Cockpit();
693 // Have to set the LatLon display type
694 fgLatLonFormat = toDM;
696 SG_LOG( SG_COCKPIT, SG_INFO,
697 " Code " << ac_cockpit->code() << " Status "
698 << ac_cockpit->status() );
703 void fgCockpitUpdate( void ) {
705 SG_LOG( SG_COCKPIT, SG_DEBUG,
706 "Cockpit: code " << ac_cockpit->code() << " status "
707 << ac_cockpit->status() );
709 static const SGPropertyNode * xsize_node = fgGetNode("/sim/startup/xsize");
710 static const SGPropertyNode * ysize_node = fgGetNode("/sim/startup/ysize");
711 static const SGPropertyNode * hud_visibility_node
712 = fgGetNode("/sim/hud/visibility");
714 int iwidth = xsize_node->getIntValue();
715 int iheight = ysize_node->getIntValue();
716 float width = iwidth;
717 // float height = iheight;
719 // FIXME: inefficient
720 if ( hud_visibility_node->getBoolValue() ) {
721 // This will check the global hud linked list pointer.
722 // If these is anything to draw it will.
726 if ( fgGetBool( "/sim/hud/draw-fps", false ) ) {
728 float fps = get_frame_rate();
729 sprintf(buf,"%-5.1f", fps);
731 glMatrixMode( GL_PROJECTION );
734 gluOrtho2D( 0, iwidth, 0, iheight );
735 glMatrixMode( GL_MODELVIEW );
739 glDisable( GL_DEPTH_TEST );
740 glDisable( GL_LIGHTING );
742 glColor3f( 0.9, 0.4, 0.2 );
744 guiFnt.drawString( buf,
745 int(width - guiFnt.getStringWidth(buf) - 10),
747 glEnable( GL_DEPTH_TEST );
748 glEnable( GL_LIGHTING );
749 glMatrixMode( GL_PROJECTION );
751 glMatrixMode( GL_MODELVIEW );
755 glViewport( 0, 0, iwidth, iheight );