1997-05-29 02:29:42 +00:00
|
|
|
/**************************************************************************
|
1998-10-16 23:26:44 +00:00
|
|
|
* slew.cxx -- the "slew" flight model
|
1997-05-29 02:29:42 +00:00
|
|
|
*
|
|
|
|
* Written by Curtis Olson, started May 1997.
|
|
|
|
*
|
|
|
|
* Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
|
|
|
|
*
|
|
|
|
* 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*
|
|
|
|
* $Id$
|
|
|
|
* (Log is kept at end of this file)
|
|
|
|
**************************************************************************/
|
|
|
|
|
|
|
|
|
|
|
|
#include <math.h>
|
|
|
|
|
1998-10-16 23:26:44 +00:00
|
|
|
#include "slew.hxx"
|
|
|
|
|
|
|
|
#include <Flight/flight.hxx>
|
|
|
|
#include <Aircraft/aircraft.hxx>
|
1998-01-19 19:26:51 +00:00
|
|
|
#include <Controls/controls.h>
|
1998-01-27 00:47:41 +00:00
|
|
|
#include <Include/fg_constants.h>
|
1997-05-29 02:29:42 +00:00
|
|
|
|
|
|
|
|
|
|
|
/* reset flight params to a specific position */
|
|
|
|
void fgSlewInit(double pos_x, double pos_y, double pos_z, double heading) {
|
1998-02-07 15:29:31 +00:00
|
|
|
fgFLIGHT *f;
|
1997-05-29 02:29:42 +00:00
|
|
|
|
1998-02-07 15:29:31 +00:00
|
|
|
f = current_aircraft.flight;
|
1997-05-29 02:29:42 +00:00
|
|
|
|
1998-01-19 18:40:15 +00:00
|
|
|
/*
|
|
|
|
f->pos_x = pos_x;
|
1997-05-29 02:29:42 +00:00
|
|
|
f->pos_y = pos_y;
|
|
|
|
f->pos_z = pos_z;
|
|
|
|
|
|
|
|
f->vel_x = 0.0;
|
|
|
|
f->vel_y = 0.0;
|
|
|
|
f->vel_z = 0.0;
|
|
|
|
|
|
|
|
f->Phi = 0.0;
|
|
|
|
f->Theta = 0.0;
|
|
|
|
f->Psi = 0.0;
|
|
|
|
|
|
|
|
f->vel_Phi = 0.0;
|
|
|
|
f->vel_Theta = 0.0;
|
|
|
|
f->vel_Psi = 0.0;
|
|
|
|
|
1998-01-19 18:40:15 +00:00
|
|
|
f->Psi = heading;
|
|
|
|
*/
|
1997-05-29 02:29:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* update position based on inputs, positions, velocities, etc. */
|
1998-01-19 18:40:15 +00:00
|
|
|
void fgSlewUpdate( void ) {
|
1998-02-07 15:29:31 +00:00
|
|
|
fgFLIGHT *f;
|
|
|
|
fgCONTROLS *c;
|
1997-05-29 02:29:42 +00:00
|
|
|
|
1998-02-07 15:29:31 +00:00
|
|
|
f = current_aircraft.flight;
|
|
|
|
c = current_aircraft.controls;
|
1997-05-29 02:29:42 +00:00
|
|
|
|
1997-05-29 22:39:49 +00:00
|
|
|
/* f->Psi += ( c->aileron / 8 );
|
1997-07-19 22:35:06 +00:00
|
|
|
if ( f->Psi > FG_2PI ) {
|
|
|
|
f->Psi -= FG_2PI;
|
1997-05-29 02:29:42 +00:00
|
|
|
} else if ( f->Psi < 0 ) {
|
1997-07-19 22:35:06 +00:00
|
|
|
f->Psi += FG_2PI;
|
1997-05-29 02:29:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
f->vel_x = -c->elev;
|
|
|
|
|
|
|
|
f->pos_x = f->pos_x + (cos(f->Psi) * f->vel_x);
|
1997-05-29 22:39:49 +00:00
|
|
|
f->pos_y = f->pos_y + (sin(f->Psi) * f->vel_x); */
|
1997-05-29 02:29:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* $Log$
|
1998-10-16 23:26:44 +00:00
|
|
|
/* Revision 1.1 1998/10/16 23:27:50 curt
|
|
|
|
/* C++-ifying.
|
1997-05-29 02:29:42 +00:00
|
|
|
/*
|
1998-10-16 23:26:44 +00:00
|
|
|
* Revision 1.13 1998/04/25 22:06:29 curt
|
|
|
|
* Edited cvs log messages in source files ... bad bad bad!
|
|
|
|
*
|
1998-04-25 22:06:24 +00:00
|
|
|
* Revision 1.12 1998/04/08 23:35:30 curt
|
|
|
|
* Tweaks to Gnu automake/autoconf system.
|
|
|
|
*
|
1998-04-08 23:32:28 +00:00
|
|
|
* Revision 1.11 1998/02/07 15:29:39 curt
|
|
|
|
* Incorporated HUD changes and struct/typedef changes from Charlie Hotchkiss
|
|
|
|
* <chotchkiss@namg.us.anritsu.com>
|
|
|
|
*
|
1998-02-07 15:29:31 +00:00
|
|
|
* Revision 1.10 1998/01/27 00:47:53 curt
|
1998-04-25 22:06:24 +00:00
|
|
|
* Incorporated Paul Bleisch's <pbleisch@acm.org> new debug message
|
1998-02-07 15:29:31 +00:00
|
|
|
* system and commandline/config file processing code.
|
|
|
|
*
|
1998-01-27 00:47:41 +00:00
|
|
|
* Revision 1.9 1998/01/19 19:27:06 curt
|
|
|
|
* Merged in make system changes from Bob Kuehne <rpk@sgi.com>
|
|
|
|
* This should simplify things tremendously.
|
|
|
|
*
|
1998-01-19 19:26:51 +00:00
|
|
|
* Revision 1.8 1998/01/19 18:40:30 curt
|
|
|
|
* Tons of little changes to clean up the code and to remove fatal errors
|
|
|
|
* when building with the c++ compiler.
|
|
|
|
*
|
1998-01-19 18:40:15 +00:00
|
|
|
* Revision 1.7 1997/12/15 23:54:42 curt
|
|
|
|
* Add xgl wrappers for debugging.
|
|
|
|
* Generate terrain normals on the fly.
|
|
|
|
*
|
1997-12-15 23:54:25 +00:00
|
|
|
* Revision 1.6 1997/08/27 03:30:11 curt
|
|
|
|
* Changed naming scheme of basic shared structures.
|
|
|
|
*
|
1997-08-27 03:29:38 +00:00
|
|
|
* Revision 1.5 1997/07/19 22:35:06 curt
|
|
|
|
* Moved fiddled with PI to avoid compiler warnings.
|
|
|
|
*
|
1997-07-19 22:35:06 +00:00
|
|
|
* Revision 1.4 1997/06/21 17:12:51 curt
|
|
|
|
* Capitalized subdirectory names.
|
|
|
|
*
|
1997-06-21 17:12:38 +00:00
|
|
|
* Revision 1.3 1997/05/29 22:40:00 curt
|
|
|
|
* Working on incorporating the LaRCsim flight model.
|
|
|
|
*
|
1997-05-29 22:39:49 +00:00
|
|
|
* Revision 1.2 1997/05/29 12:30:19 curt
|
|
|
|
* Some initial mods to work better in a timer environment.
|
|
|
|
*
|
1997-05-29 12:30:19 +00:00
|
|
|
* Revision 1.1 1997/05/29 02:29:42 curt
|
|
|
|
* Moved to their own directory.
|
|
|
|
*
|
1997-05-29 02:29:42 +00:00
|
|
|
* Revision 1.2 1997/05/23 15:40:37 curt
|
|
|
|
* Added GNU copyright headers.
|
|
|
|
*
|
|
|
|
* Revision 1.1 1997/05/16 16:04:45 curt
|
|
|
|
* Initial revision.
|
|
|
|
*
|
|
|
|
*/
|