src/Cockpit/cockpit.cxx

   1 // cockpit.cxx -- routines to draw a cockpit (initial draft)
   2 //
   3 // Written by Michele America, started September 1997.
   4 //
   5 // Copyright (C) 1997  Michele F. America  - nomimarketing@mail.telepac.pt
   6 //
   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.
  11 //
  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.
  16 //
  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.
  20 //
  21 // $Id$
  22
  23
  24 #ifdef HAVE_CONFIG_H
  25 #  include <config.h>
  26 #endif
  27
  28 #ifdef HAVE_WINDOWS_H
  29 #  include <windows.h>
  30 #endif
  31
  32 #include <stdlib.h>
  33 #include <stdio.h>
  34 #include <string.h>
  35
  36 #include <simgear/constants.h>
  37 #include <simgear/debug/logstream.hxx>
  38 #include <simgear/math/polar3d.hxx>
  39 #include <simgear/props/props.hxx>
  40 #include <simgear/timing/sg_time.hxx>
  41
  42 #include <Aircraft/aircraft.hxx>
  43 #include <Include/general.hxx>
  44 #include <FDM/ADA.hxx>
  45 #include <Main/globals.hxx>
  46 #include <Main/fg_props.hxx>
  47 #include <Main/viewmgr.hxx>
  48 #include <Scenery/scenery.hxx>
  49 #include <Time/fg_timer.hxx>
  50 #include <GUI/gui.h>
  51
  52 #include "cockpit.hxx"
  53 #include "hud.hxx"
  54
  55
  56 // This is a structure that contains all data related to
  57 // cockpit/panel/hud system
  58
  59 static pCockpit ac_cockpit;
  60 // The following routines obtain information concerntin the aircraft's
  61 // current state and return it to calling instrument display routines.
  62 // They should eventually be member functions of the aircraft.
  63 //
  64
  65 float get_latitude( void )
  66 {
  67     return current_aircraft.fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES;
  68 }
  69
  70 float get_lat_min( void )
  71 {
  72     double a, d;
  73
  74     a = current_aircraft.fdm_state->get_Latitude() * SGD_RADIANS_TO_DEGREES;
  75     if (a < 0.0) {
  76         a = -a;
  77     }
  78     d = (double) ( (int) a);
  79     float lat_min = (a - d) * 60.0;
  80
  81     return lat_min;
  82 }
  83
  84
  85 float get_longitude( void )
  86 {
  87     return current_aircraft.fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES;
  88 }
  89
  90
  91 char*
  92 get_formated_gmt_time( void )
  93 {
  94     static char buf[32];
  95     const struct tm *p = globals->get_time_params()->getGmt();
  96     sprintf( buf, "%d/%d/%4d %d:%02d:%02d",
  97          p->tm_mon+1, p->tm_mday, 1900 + p->tm_year,
  98          p->tm_hour, p->tm_min, p->tm_sec);
  99
 100     return buf;
 101 }
 102
 103
 104 float get_long_min( void )
 105 {
 106     double  a, d;
 107     a = current_aircraft.fdm_state->get_Longitude() * SGD_RADIANS_TO_DEGREES;
 108     if (a < 0.0) {
 109         a = -a;
 110     }
 111     d = (double) ( (int) a);
 112     float lon_min = (a - d) * 60.0;
 113
 114     return lon_min;
 115 }
 116
 117 float get_throttleval( void )
 118 {
 119     // Hack limiting to one engine
 120     return globals->get_controls()->get_throttle( 0 );
 121 }
 122
 123 float get_aileronval( void )
 124 {
 125     return globals->get_controls()->get_aileron();
 126 }
 127
 128 float get_elevatorval( void )
 129 {
 130     return globals->get_controls()->get_elevator();
 131 }
 132
 133 float get_elev_trimval( void )
 134 {
 135     return globals->get_controls()->get_elevator_trim();
 136 }
 137
 138 float get_rudderval( void )
 139 {
 140     return globals->get_controls()->get_rudder();
 141 }
 142
 143 float get_speed( void )
 144 {
 145     static const SGPropertyNode * speedup_node = fgGetNode("/sim/speed-up");
 146
 147     float speed = current_aircraft.fdm_state->get_V_calibrated_kts()
 148         * speedup_node->getIntValue();
 149
 150     return speed;
 151 }
 152
 153 float get_mach(void)
 154 {
 155     return current_aircraft.fdm_state->get_Mach_number();
 156 }
 157
 158 float get_aoa( void )
 159 {
 160     return current_aircraft.fdm_state->get_Alpha() * SGD_RADIANS_TO_DEGREES;
 161 }
 162
 163 float get_roll( void )
 164 {
 165     return current_aircraft.fdm_state->get_Phi();
 166 }
 167
 168 float get_pitch( void )
 169 {
 170     return current_aircraft.fdm_state->get_Theta();
 171 }
 172
 173 float get_heading( void )
 174 {
 175     return current_aircraft.fdm_state->get_Psi() * SGD_RADIANS_TO_DEGREES;
 176 }
 177
 178 float get_altitude( void )
 179 {
 180     static const SGPropertyNode *startup_units_node
 181         = fgGetNode("/sim/startup/units");
 182
 183     float altitude;
 184
 185     if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
 186         altitude = current_aircraft.fdm_state->get_Altitude();
 187     } else {
 188         altitude = (current_aircraft.fdm_state->get_Altitude()
 189                     * SG_FEET_TO_METER);
 190     }
 191
 192     return altitude;
 193 }
 194
 195 float get_agl( void )
 196 {
 197     static const SGPropertyNode *startup_units_node
 198         = fgGetNode("/sim/startup/units");
 199
 200     float agl;
 201
 202     if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
 203         agl = (current_aircraft.fdm_state->get_Altitude()
 204                - globals->get_scenery()->get_cur_elev() * SG_METER_TO_FEET);
 205     } else {
 206         agl = (current_aircraft.fdm_state->get_Altitude() * SG_FEET_TO_METER
 207                - globals->get_scenery()->get_cur_elev());
 208     }
 209
 210     return agl;
 211 }
 212
 213 float get_sideslip( void )
 214 {
 215     return current_aircraft.fdm_state->get_Beta();
 216 }
 217
 218 float get_frame_rate( void )
 219 {
 220     return general.get_frame_rate();
 221 }
 222
 223 float get_fov( void )
 224 {
 225     return globals->get_current_view()->get_fov();
 226 }
 227
 228 float get_vfc_ratio( void )
 229 {
 230     // float vfc = current_view.get_vfc_ratio();
 231     // return (vfc);
 232     return 0.0;
 233 }
 234
 235 float get_vfc_tris_drawn   ( void )
 236 {
 237     // float rendered = current_view.get_tris_rendered();
 238     // return (rendered);
 239     return 0.0;
 240 }
 241
 242 float get_vfc_tris_culled   ( void )
 243 {
 244     // float culled = current_view.get_tris_culled();
 245     // return (culled);
 246     return 0.0;
 247 }
 248
 249 float get_climb_rate( void )
 250 {
 251     static const SGPropertyNode *startup_units_node
 252         = fgGetNode("/sim/startup/units");
 253
 254     float climb_rate;
 255     if ( !strcmp(startup_units_node->getStringValue(), "feet") ) {
 256         climb_rate = current_aircraft.fdm_state->get_Climb_Rate() * 60.0;
 257     } else {
 258         climb_rate = current_aircraft.fdm_state->get_Climb_Rate() * SG_FEET_TO_METER * 60.0;
 259     }
 260
 261     return climb_rate;
 262 }
 263
 264
 265 float get_view_direction( void )
 266 {
 267     double view_off = SGD_2PI - globals->get_current_view()->getHeadingOffset_deg() * SGD_DEGREES_TO_RADIANS;
 268     double view = ( current_aircraft.fdm_state->get_Psi() + view_off)
 269         * SGD_RADIANS_TO_DEGREES;
 270
 271     if(view > 360.)
 272         view -= 360.;
 273     else if(view<0.)
 274         view += 360.;
 275
 276     return view;
 277 }
 278
 279 // Added by Markus Hof on 5. Jan 2004
 280 float get_dme( void )
 281 {
 282     static const SGPropertyNode * dme_node =
 283         fgGetNode("/radios/dme/distance-nm");
 284
 285     return dme_node->getFloatValue();
 286 }
 287
 288 // $$$ begin - added, VS Renganathan 13 Oct 2K
 289 // #ifdef FIGHTER_HUD
 290 float get_Vx   ( void )
 291 {
 292     // Curt dont comment this and return zero. - Ranga
 293     // Please remove comments from get_V_..() function in flight.hxx
 294     float Vxx = current_aircraft.fdm_state->get_V_north_rel_ground();
 295     return Vxx;
 296 }
 297
 298 float get_Vy   ( void )
 299 {
 300     // Curt dont comment this and return zero. - Ranga
 301     // Please remove comments from get_V_..() function in flight.hxx
 302     float Vyy = current_aircraft.fdm_state->get_V_east_rel_ground();
 303     return Vyy;
 304 }
 305
 306 float get_Vz   ( void )
 307 {
 308     // Curt dont comment this and return zero. - Ranga
 309     // Please remove comments from get_V_..() function in flight.hxx
 310     float Vzz = current_aircraft.fdm_state->get_V_down_rel_ground();
 311     return Vzz;
 312 }
 313
 314 float get_Ax   ( void )
 315 {
 316     float Ax = current_aircraft.fdm_state->get_V_dot_north();
 317     return Ax;
 318 }
 319
 320 float get_Ay   ( void )
 321 {
 322     float Ay = current_aircraft.fdm_state->get_V_dot_east();
 323     return Ay;
 324 }
 325
 326 float get_Az   ( void )
 327 {
 328     float Az = current_aircraft.fdm_state->get_V_dot_down();
 329     return Az;
 330 }
 331
 332 float get_anzg   ( void )
 333 {
 334     float anzg = current_aircraft.fdm_state->get_N_Z_cg();
 335     return anzg;
 336 }
 337
 338 int get_iaux1 (void)
 339 {
 340     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 341     return fdm->get_iaux(1);
 342 }
 343
 344 int get_iaux2 (void)
 345 {
 346     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 347     return fdm->get_iaux(2);
 348 }
 349
 350 int get_iaux3 (void)
 351 {
 352     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 353     return fdm->get_iaux(3);
 354 }
 355
 356 int get_iaux4 (void)
 357 {
 358     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 359     return fdm->get_iaux(4);
 360 }
 361
 362 int get_iaux5 (void)
 363 {
 364     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 365     return fdm->get_iaux(5);
 366 }
 367
 368 int get_iaux6 (void)
 369 {
 370     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 371     return fdm->get_iaux(6);
 372 }
 373
 374 int get_iaux7 (void)
 375 {
 376     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 377     return fdm->get_iaux(7);
 378 }
 379
 380 int get_iaux8 (void)
 381 {
 382     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 383     return fdm->get_iaux(8);
 384 }
 385
 386 int get_iaux9 (void)
 387 {
 388     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 389     return fdm->get_iaux(9);
 390 }
 391
 392 int get_iaux10 (void)
 393 {
 394     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 395     return fdm->get_iaux(10);
 396 }
 397
 398 int get_iaux11 (void)
 399 {
 400     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 401     return fdm->get_iaux(11);
 402 }
 403
 404 int get_iaux12 (void)
 405 {
 406      FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 407      return fdm->get_iaux(12);
 408 }
 409
 410 float get_aux1 (void)
 411 {
 412     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 413     return fdm->get_daux(1);
 414 }
 415
 416 float get_aux2 (void)
 417 {
 418     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 419     return fdm->get_daux(2);
 420 }
 421
 422 float get_aux3 (void)
 423 {
 424     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 425     return fdm->get_daux(3);
 426 }
 427
 428 float get_aux4 (void)
 429 {
 430     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 431     return fdm->get_daux(4);
 432 }
 433
 434 float get_aux5 (void)
 435 {
 436     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 437     return fdm->get_daux(5);
 438 }
 439
 440 float get_aux6 (void)
 441 {
 442     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 443     return fdm->get_daux(6);
 444 }
 445
 446 float get_aux7 (void)
 447 {
 448     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 449     return fdm->get_daux(7);
 450 }
 451
 452 float get_aux8 (void)
 453 {
 454     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 455     return fdm->get_daux(8);
 456 }
 457
 458 float get_aux9 (void)
 459 {
 460     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 461     return fdm->get_faux(1);
 462 }
 463
 464 float get_aux10 (void)
 465 {
 466     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 467     return fdm->get_faux(2);
 468 }
 469
 470 float get_aux11 (void)
 471 {
 472     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 473     return fdm->get_faux(3);
 474 }
 475
 476 float get_aux12 (void)
 477 {
 478     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 479     return fdm->get_faux(4);
 480 }
 481
 482 float get_aux13 (void)
 483 {
 484     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 485     return fdm->get_faux(5);
 486 }
 487
 488 float get_aux14 (void)
 489 {
 490     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 491     return fdm->get_faux(6);
 492 }
 493
 494 float get_aux15 (void)
 495 {
 496     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 497     return fdm->get_faux(7);
 498 }
 499
 500 float get_aux16 (void)
 501 {
 502     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 503     return fdm->get_faux(8);
 504 }
 505
 506 float get_aux17 (void)
 507 {
 508     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 509     return fdm->get_faux(9);
 510 }
 511
 512 float get_aux18 (void)
 513 {
 514     FGADA *fdm = (FGADA *)current_aircraft.fdm_state;
 515     return fdm->get_faux(10);
 516 }
 517 // #endif
 518 // $$$ end - added, VS Renganathan 13 Oct 2K
 519
 520
 521 #ifdef NOT_USED
 522 /****************************************************************************/
 523 /* Convert degrees to dd mm'ss.s" (DMS-Format)                              */
 524 /****************************************************************************/
 525 char *dmshh_format(double degrees)
 526 {
 527     static char buf[16];
 528     int deg_part;
 529     int min_part;
 530     double sec_part;
 531
 532     if (degrees < 0)
 533       degrees = -degrees;
 534
 535     deg_part = degrees;
 536     min_part = 60.0 * (degrees - deg_part);
 537     sec_part = 3600.0 * (degrees - deg_part - min_part / 60.0);
 538
 539     /* Round off hundredths */
 540     if (sec_part + 0.005 >= 60.0)
 541       sec_part -= 60.0, min_part += 1;
 542     if (min_part >= 60)
 543       min_part -= 60, deg_part += 1;
 544
 545     sprintf(buf,"%02d*%02d %05.2f",deg_part,min_part,sec_part);
 546
 547     return buf;
 548 }
 549 #endif // 0
 550
 551
 552 /************************************************************************
 553  Convert degrees to dd mm.mmm' (DMM-Format)
 554  Description: Converts using a round-off factor tailored to the required
 555  precision of the minutes field (three decimal places).  Round-off
 556  prevents function from returning a minutes value of 60.
 557
 558  Input arguments: Coordinate value in decimal degrees
 559
 560 ************************************************************************/
 561 static char *toDM(float dd)
 562 {
 563     static char  dm[16];
 564     double tempdd;
 565     double mn;
 566     double sign = 1;
 567     int deg;
 568
 569     if (dd < 0) {
 570         sign = -1;
 571     }
 572     /* round for minutes expressed to three decimal places */
 573     tempdd = fabs(dd) + (5.0E-4 / 60.0);
 574     deg = (int)tempdd;
 575     mn = fabs( (tempdd - (double)(deg)) * 60.0 - 4.999E-4 );
 576     deg *= (int)sign;
 577     sprintf(dm, "%d*%06.3f", deg, mn);
 578     return dm;
 579 }
 580
 581
 582 /************************************************************************
 583  Convert degrees to dd mm'ss.s'' (DMS-Format)
 584  Description: Converts using a round-off factor tailored to the required
 585  precision of the seconds field (one decimal place).  Round-off
 586  prevents function from returning a seconds value of 60.
 587
 588  Input arguments: Coordinate value in decimal degrees
 589
 590 ************************************************************************/
 591 static char *toDMS(float dd)
 592 {
 593     static char  dms[16];
 594     double tempdd, tempmin;
 595     int deg;
 596     int mn;
 597     double sec;
 598     double sign = 1;
 599
 600     if(dd < 0) {
 601         sign = -1;
 602     }
 603     /* round up for seconds expressed to one decimal place */
 604     tempdd = fabs(dd) + (0.05 / 3600.0);
 605     deg = (int)tempdd;
 606     tempmin =  (tempdd - (double)(deg)) * 60.0;
 607     mn = (int)tempmin;
 608     sec = fabs( (tempmin - (double)(mn)) * 60.0 - 0.049 );
 609     deg *= (int)sign;
 610     sprintf(dms, "%d*%02d %04.1f", deg, mn, sec);
 611     return dms;
 612 }
 613
 614
 615 // Have to set the LatLon display type
 616 //static char *(*fgLatLonFormat)(float) = toDM;
 617 static char *(*fgLatLonFormat)(float);
 618
 619 char *coord_format_lat(float latitude)
 620 {
 621     static char buf[16];
 622
 623     sprintf(buf,"%s%c",
 624 //      dmshh_format(latitude),
 625 //      toDMS(latitude),
 626 //      toDM(latitude),
 627         fgLatLonFormat(latitude),
 628         latitude > 0 ? 'N' : 'S');
 629     return buf;
 630 }
 631
 632 char *coord_format_lon(float longitude)
 633 {
 634     static char buf[80];
 635
 636     sprintf(buf,"%s%c",
 637 //      dmshh_format(longitude),
 638 //      toDMS(longitude),
 639 //      toDM(longitude),
 640         fgLatLonFormat(longitude),
 641         longitude > 0 ? 'E' : 'W');
 642     return buf;
 643 }
 644
 645 void fgLatLonFormatToggle( puObject *)
 646 {
 647     static int toggle = 0;
 648
 649     if ( toggle )
 650         fgLatLonFormat = toDM;
 651     else
 652         fgLatLonFormat = toDMS;
 653
 654     toggle = ~toggle;
 655 }
 656
 657 #ifdef NOT_USED
 658 char *coord_format_latlon(double latitude, double longitude)
 659 {
 660     static char buf[1024];
 661
 662     sprintf(buf,"%s%c %s%c",
 663         dmshh_format(latitude),
 664         latitude > 0 ? 'N' : 'S',
 665         dmshh_format(longitude),
 666         longitude > 0 ? 'E' : 'W');
 667     return buf;
 668 }
 669 #endif
 670
 671
 672 bool fgCockpitInit( fgAIRCRAFT *cur_aircraft )
 673 {
 674     SG_LOG( SG_COCKPIT, SG_INFO, "Initializing cockpit subsystem" );
 675
 676     //  cockpit->code = 1;  /* It will be aircraft dependent */
 677     //  cockpit->status = 0;
 678
 679     // If aircraft has HUD specified we will get the specs from its def
 680     // file. For now we will depend upon hard coding in hud?
 681
 682     // We must insure that the existing instrument link is purged.
 683     // This is done by deleting the links in the list.
 684
 685     // HI_Head is now a null pointer so we can generate a new list from the
 686     // current aircraft.
 687
 688     fgHUDInit( cur_aircraft );
 689     ac_cockpit = new fg_Cockpit();
 690
 691     // Have to set the LatLon display type
 692     fgLatLonFormat = toDM;
 693
 694     SG_LOG( SG_COCKPIT, SG_INFO,
 695         "  Code " << ac_cockpit->code() << " Status "
 696         << ac_cockpit->status() );
 697
 698         return true;
 699 }
 700
 701 void fgCockpitUpdate( void ) {
 702
 703     SG_LOG( SG_COCKPIT, SG_DEBUG,
 704             "Cockpit: code " << ac_cockpit->code() << " status "
 705             << ac_cockpit->status() );
 706
 707     static const SGPropertyNode * xsize_node = fgGetNode("/sim/startup/xsize");
 708     static const SGPropertyNode * ysize_node = fgGetNode("/sim/startup/ysize");
 709     static const SGPropertyNode * hud_visibility_node
 710         = fgGetNode("/sim/hud/visibility");
 711
 712     int iwidth   = xsize_node->getIntValue();
 713     int iheight  = ysize_node->getIntValue();
 714     float width  = iwidth;
 715     // float height = iheight;
 716
 717                                 // FIXME: inefficient
 718     if ( hud_visibility_node->getBoolValue() ) {
 719         // This will check the global hud linked list pointer.
 720         // If these is anything to draw it will.
 721         fgUpdateHUD();
 722     }
 723
 724 #define DISPLAY_COUNTER
 725 #ifdef DISPLAY_COUNTER
 726     else
 727     {
 728         char buf[64];
 729         float fps    =       get_frame_rate();
 730 //      float tris   = fps * get_vfc_tris_drawn();
 731 //      float culled = fps * get_vfc_tris_culled();
 732 //      sprintf(buf,"%-4.1f  %7.0f  %7.0f", fps, tris, culled);
 733         sprintf(buf,"%-5.1f", fps);
 734
 735         glMatrixMode( GL_PROJECTION );
 736         glPushMatrix();
 737         glLoadIdentity();
 738         gluOrtho2D( 0, iwidth, 0, iheight );
 739         glMatrixMode( GL_MODELVIEW );
 740         glPushMatrix();
 741         glLoadIdentity();
 742
 743         glDisable( GL_DEPTH_TEST );
 744         glDisable( GL_LIGHTING );
 745
 746         glColor3f( 0.9, 0.4, 0.2 );
 747
 748         guiFnt.drawString( buf,
 749                            int(width - guiFnt.getStringWidth(buf) - 10),
 750                            10 );
 751         glEnable( GL_DEPTH_TEST );
 752         glEnable( GL_LIGHTING );
 753         glMatrixMode( GL_PROJECTION );
 754         glPopMatrix();
 755         glMatrixMode( GL_MODELVIEW );
 756         glPopMatrix();
 757     }
 758 #endif // #ifdef DISPLAY_COUNTER
 759
 760     glViewport( 0, 0, iwidth, iheight );
 761 }
 762