FGTrimAnalysisControl.h

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

 Header:       FGTrimAnalysisControl.h
 Author:       Agostino De Marco
 Date started: Dec/14/2006

 ------------- Copyright (C) 2006  Agostino De Marco (agodemar@unina.it) -------

 This program is free software; you can redistribute it and/or modify it under
 the terms of the GNU Lesser 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 Lesser General Public License for more
 details.

 You should have received a copy of the GNU Lesser General Public License along with
 this program; if not, write to the Free Software Foundation, Inc., 59 Temple
 Place - Suite 330, Boston, MA  02111-1307, USA.

 Further information about the GNU Lesser General Public License can also be found on
 the world wide web at http://www.gnu.org.


 HISTORY
--------------------------------------------------------------------------------
12/14/06   ADM   Created


FUNCTIONAL DESCRIPTION
--------------------------------------------------------------------------------


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
SENTRY
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

#ifndef FGTRIMANALYSISCONTROL_H
#define FGTRIMANALYSISCONTROL_H

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
INCLUDES
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

#include <string>

#include "FGFDMExec.h"
#include "FGJSBBase.h"
#include "initialization/FGInitialCondition.h"

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
DEFINITIONS
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

#define ID_TRIMANALYSISCONTROL "$Id: FGTrimAnalysisControl.h,v 1.2 2009/10/02 10:30:09 jberndt Exp $"

#define DEFAULT_TRIM_ANALYSIS_TOLERANCE 0.00000001

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
FORWARD DECLARATIONS
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

namespace JSBSim {

class FGInitialCondition;

enum TaState { taAll,taUdot,taVdot,taWdot,taQdot,taPdot,taRdot,taHmgt,taNlf };
enum TaControl { taThrottle = 0,
                 taPitchTrim, taRollTrim, taYawTrim,
                 taElevator,  taAileron,  taRudder,
                 taPhi, taTheta, taHeading,
                 taGamma, taAltAGL, taBeta, taAlpha};

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
CLASS DOCUMENTATION
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
CLASS DECLARATION
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

class FGTrimAnalysisControl : public FGJSBBase
{
public:
  FGTrimAnalysisControl(FGFDMExec* fdmex,
                        FGInitialCondition *IC,
                        //State state,
                        TaControl control );
  ~FGTrimAnalysisControl();

  void Run(void);

  //double GetState(void) { getState(); return state_value; }
  //Accels are not settable

  inline void SetControl(double value ) { control_value=value; }

  inline double GetControl(void) { return control_value; }

  //inline State GetStateType(void) { return state; }
  inline TaControl GetControlType(void) { return control; }

  //inline string GetStateName(void) { return StateNames[state]; }

  inline string GetControlName(void) { return control_name; }

  inline double GetControlMin(void) { return control_min; }
inline double GetControlMax(void) { return control_max; }

  inline void SetControlStep(double value) { control_step = value; }
  inline double GetControlStep(void) { return control_step; }

  inline void SetControlInitialValue(double value) { control_initial_value = value; }

  inline double GetControlInitialValue(void) { return control_initial_value; }

  inline void SetControlToMin(void) { control_value=control_min; }

  inline void SetControlToMax(void) { control_value=control_max; }

  inline void SetControlLimits(double min, double max) {
      control_min=min;
      control_max=max;
  }

  inline void  SetTolerance(double ff) { control_tolerance=ff;}

  inline double GetTolerance(void) { return control_tolerance; }

  void SetThetaOnGround(double ff);

  void SetPhiOnGround(double ff);

  inline void SetStateTarget(double target) { state_target=target; }

  inline double GetStateTarget(void) { return state_target; }

  bool initTheta(void);

private:
  FGFDMExec *fdmex;
  FGInitialCondition *fgic;

  TaState   state;
  TaControl control;

  string control_name;

  double state_target;

  double state_value;
  double control_value;

  double control_min;
  double control_max;

  double control_initial_value;
  double control_step;
  double control_tolerance;

  double state_convert;
  double control_convert;

  void setThrottlesPct(void);

  void getState(void);
  void getControl(void);
  void setControl(void);

  double computeHmgt(void);

  void Debug(int from);
};
}
#endif