1998-10-17 01:33:52 +00:00
|
|
|
// slew.cxx -- the "slew" flight model
|
|
|
|
//
|
|
|
|
// 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)
|
1997-05-29 02:29:42 +00:00
|
|
|
|
|
|
|
|
|
|
|
#include <math.h>
|
|
|
|
|
1998-10-16 23:26:44 +00:00
|
|
|
#include "slew.hxx"
|
|
|
|
|
1999-02-01 21:33:23 +00:00
|
|
|
#include <FDM/flight.hxx>
|
1998-10-16 23:26:44 +00:00
|
|
|
#include <Aircraft/aircraft.hxx>
|
1998-10-17 01:33:52 +00:00
|
|
|
#include <Controls/controls.hxx>
|
1998-01-27 00:47:41 +00:00
|
|
|
#include <Include/fg_constants.h>
|
1997-05-29 02:29:42 +00:00
|
|
|
|
|
|
|
|
1998-10-17 01:33:52 +00:00
|
|
|
// reset flight params to a specific position
|
1997-05-29 02:29:42 +00:00
|
|
|
void fgSlewInit(double pos_x, double pos_y, double pos_z, double heading) {
|
1998-12-05 15:53:59 +00:00
|
|
|
FGState *f;
|
|
|
|
|
|
|
|
f = current_aircraft.fdm_state;
|
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
|
|
|
}
|
|
|
|
|
|
|
|
|
1998-10-17 01:33:52 +00:00
|
|
|
// update position based on inputs, positions, velocities, etc.
|
1998-01-19 18:40:15 +00:00
|
|
|
void fgSlewUpdate( void ) {
|
1998-12-05 15:53:59 +00:00
|
|
|
FGState *f;
|
1998-12-05 16:13:10 +00:00
|
|
|
FGControls *c;
|
1997-05-29 02:29:42 +00:00
|
|
|
|
1998-12-05 15:53:59 +00:00
|
|
|
f = current_aircraft.fdm_state;
|
1998-02-07 15:29:31 +00:00
|
|
|
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
|
|
|
}
|
|
|
|
|
|
|
|
|
1998-10-17 01:33:52 +00:00
|
|
|
// $Log$
|
1999-02-01 21:33:23 +00:00
|
|
|
// Revision 1.5 1999/02/01 21:33:33 curt
|
|
|
|
// Renamed FlightGear/Simulator/Flight to FlightGear/Simulator/FDM since
|
|
|
|
// Jon accepted my offer to do this and thought it was a good idea.
|
|
|
|
//
|
1998-12-05 16:13:10 +00:00
|
|
|
// Revision 1.4 1998/12/05 16:13:14 curt
|
|
|
|
// Renamed class fgCONTROLS to class FGControls.
|
|
|
|
//
|
1998-12-05 15:53:59 +00:00
|
|
|
// Revision 1.3 1998/12/05 15:54:16 curt
|
|
|
|
// Renamed class fgFLIGHT to class FGState as per request by JSB.
|
|
|
|
//
|
1998-10-17 01:33:52 +00:00
|
|
|
// Revision 1.2 1998/10/17 01:34:17 curt
|
|
|
|
// C++ ifying ...
|
|
|
|
//
|
|
|
|
// Revision 1.1 1998/10/16 23:27:50 curt
|
|
|
|
// C++-ifying.
|
|
|
|
//
|
|
|
|
// Revision 1.13 1998/04/25 22:06:29 curt
|
|
|
|
// Edited cvs log messages in source files ... bad bad bad!
|
|
|
|
//
|
|
|
|
// Revision 1.12 1998/04/08 23:35:30 curt
|
|
|
|
// Tweaks to Gnu automake/autoconf system.
|
|
|
|
//
|
|
|
|
// 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>
|
|
|
|
//
|
|
|
|
// Revision 1.10 1998/01/27 00:47:53 curt
|
|
|
|
// Incorporated Paul Bleisch's <pbleisch@acm.org> new debug message
|
|
|
|
// system and commandline/config file processing code.
|
|
|
|
//
|
|
|
|
// 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.
|
|
|
|
//
|
|
|
|
// 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.
|
|
|
|
//
|
|
|
|
// Revision 1.7 1997/12/15 23:54:42 curt
|
|
|
|
// Add xgl wrappers for debugging.
|
|
|
|
// Generate terrain normals on the fly.
|
|
|
|
//
|
|
|
|
// Revision 1.6 1997/08/27 03:30:11 curt
|
|
|
|
// Changed naming scheme of basic shared structures.
|
|
|
|
//
|
|
|
|
// Revision 1.5 1997/07/19 22:35:06 curt
|
|
|
|
// Moved fiddled with PI to avoid compiler warnings.
|
|
|
|
//
|
|
|
|
// Revision 1.4 1997/06/21 17:12:51 curt
|
|
|
|
// Capitalized subdirectory names.
|
|
|
|
//
|
|
|
|
// Revision 1.3 1997/05/29 22:40:00 curt
|
|
|
|
// Working on incorporating the LaRCsim flight model.
|
|
|
|
//
|
|
|
|
// Revision 1.2 1997/05/29 12:30:19 curt
|
|
|
|
// Some initial mods to work better in a timer environment.
|
|
|
|
//
|
|
|
|
// Revision 1.1 1997/05/29 02:29:42 curt
|
|
|
|
// Moved to their own directory.
|
|
|
|
//
|
|
|
|
// 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.
|
|
|
|
//
|
|
|
|
|