**************************************************************************/
#include <stdio.h>
+
+#include <Debug/fg_debug.h>
#include <Flight/flight.h>
#include <Flight/LaRCsim/ls_interface.h>
+#include <Include/fg_constants.h>
+#include <Math/fg_geodesy.h>
+
+
+fgFLIGHT cur_flight_params;
/* Initialize the flight model parameters */
-int fgFlightModelInit(int model, struct fgFLIGHT *f, double dt) {
+int fgFlightModelInit(int model, fgFLIGHT *f, double dt) {
int result;
- printf("Initializing flight model\n");
+ fgPrintf(FG_FLIGHT,FG_INFO,"Initializing flight model\n");
- if ( model == FG_LARCSIM ) {
+ if ( model == FG_SLEW ) {
+ // fgSlewInit(dt);
+ } else if ( model == FG_LARCSIM ) {
fgFlight_2_LaRCsim(f); /* translate FG to LaRCsim structure */
fgLaRCsimInit(dt);
- printf("FG pos = %.2f\n", FG_Latitude);
+ fgPrintf( FG_FLIGHT, FG_INFO, "FG pos = %.2f\n", FG_Latitude );
fgLaRCsim_2_Flight(f); /* translate LaRCsim back to FG structure */
} else {
- printf("Unimplemented flight model == %d\n", model);
+ fgPrintf( FG_FLIGHT, FG_WARN,
+ "Unimplemented flight model == %d\n", model );
}
result = 1;
/* Run multiloop iterations of the flight model */
-int fgFlightModelUpdate(int model, struct fgFLIGHT *f, int multiloop) {
+int fgFlightModelUpdate(int model, fgFLIGHT *f, int multiloop) {
int result;
- if ( model == FG_LARCSIM ) {
- fgFlight_2_LaRCsim(f); /* translate FG to LaRCsim structure */
- fgLaRCsimUpdate(multiloop);
- fgLaRCsim_2_Flight(f); /* translate LaRCsim back to FG structure */
+ // printf("Altitude = %.2f\n", FG_Altitude * 0.3048);
+
+ if ( model == FG_SLEW ) {
+ // fgSlewUpdate(f, multiloop);
+ } else if ( model == FG_LARCSIM ) {
+ fgLaRCsimUpdate(f, multiloop);
} else {
- printf("Unimplemented flight model == %d\n", model);
+ fgPrintf( FG_FLIGHT, FG_WARN,
+ "Unimplemented flight model == %d\n", model );
}
result = 1;
}
+/* Set the altitude (force) */
+int fgFlightModelSetAltitude(int model, fgFLIGHT *f, double alt_meters) {
+ double sea_level_radius_meters;
+ double lat_geoc;
+ // Set the FG variables first
+ fgGeodToGeoc( FG_Latitude, alt_meters,
+ &sea_level_radius_meters, &lat_geoc);
+
+ FG_Altitude = alt_meters * METER_TO_FEET;
+ FG_Radius_to_vehicle = FG_Altitude +
+ (sea_level_radius_meters * METER_TO_FEET);
+
+ /* additional work needed for some flight models */
+ if ( model == FG_LARCSIM ) {
+ ls_ForceAltitude(FG_Altitude);
+ }
+
+}
+
+
/* $Log$
-/* Revision 1.8 1998/01/19 19:27:03 curt
-/* Merged in make system changes from Bob Kuehne <rpk@sgi.com>
-/* This should simplify things tremendously.
+/* Revision 1.15 1998/07/30 23:44:36 curt
+/* Beginning to add support for multiple flight models.
/*
+ * Revision 1.14 1998/07/12 03:08:27 curt
+ * Added fgFlightModelSetAltitude() to force the altitude to something
+ * other than the current altitude. LaRCsim doesn't let you do this by just
+ * changing FG_Altitude.
+ *
+ * Revision 1.13 1998/04/25 22:06:28 curt
+ * Edited cvs log messages in source files ... bad bad bad!
+ *
+ * Revision 1.12 1998/04/21 16:59:33 curt
+ * Integrated autopilot.
+ * Prepairing for C++ integration.
+ *
+ * Revision 1.11 1998/04/18 04:14:04 curt
+ * Moved fg_debug.c to it's own library.
+ *
+ * Revision 1.10 1998/02/07 15:29:37 curt
+ * Incorporated HUD changes and struct/typedef changes from Charlie Hotchkiss
+ * <chotchkiss@namg.us.anritsu.com>
+ *
+ * Revision 1.9 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.8 1998/01/19 19:27:03 curt
+ * Merged in make system changes from Bob Kuehne <rpk@sgi.com>
+ * This should simplify things tremendously.
+ *
* Revision 1.7 1998/01/19 18:40:23 curt
* Tons of little changes to clean up the code and to remove fatal errors
* when building with the c++ compiler.