FGMatrix33.h

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

Header: FGMatrix33.h
Author: Tony Peden, Jon Berndt, Mathias Frolich
Date started: Unknown

 ------------- Copyright (C) 2001  Jon S. Berndt (jsb@hal-pc.org) -------------

 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
--------------------------------------------------------------------------------
??/??/??   TP   Created
03/16/2000 JSB  Added exception throwing
03/06/2004 MF   Rework of the code to make it a bit compiler friendlier

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

#ifndef FGMATRIX33_H
#define FGMATRIX33_H

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

#include <cstdlib>
#include <string>
#include <fstream>
#include <iostream>
#include <cmath>

using std::ostream;
using std::istream;
using std::cerr;
using std::cout;
using std::endl;
using std::string;

#include "FGColumnVector3.h"
#include "FGJSBBase.h"

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

#define ID_MATRIX33 "$Id: FGMatrix33.h,v 1.5 2008/07/22 02:42:17 jberndt Exp $"

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

namespace JSBSim {

class FGColumnVector3;

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

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
DECLARATION: MatrixException
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

class MatrixException : public FGJSBBase
{
public:
  string Message;
};

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

/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
DECLARATION: FGMatrix33
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/

class FGMatrix33 : public FGJSBBase
{
public:

  enum {
    eRows = 3,
    eColumns = 3
  };

  FGMatrix33(void);

  FGMatrix33(const FGMatrix33& M) {
    Entry(1,1) = M.Entry(1,1);
    Entry(2,1) = M.Entry(2,1);
    Entry(3,1) = M.Entry(3,1);
    Entry(1,2) = M.Entry(1,2);
    Entry(2,2) = M.Entry(2,2);
    Entry(3,2) = M.Entry(3,2);
    Entry(1,3) = M.Entry(1,3);
    Entry(2,3) = M.Entry(2,3);
    Entry(3,3) = M.Entry(3,3);

    Debug(0);
  }

  FGMatrix33(double m11, double m12, double m13,
             double m21, double m22, double m23,
             double m31, double m32, double m33) {
    Entry(1,1) = m11;
    Entry(2,1) = m21;
    Entry(3,1) = m31;
    Entry(1,2) = m12;
    Entry(2,2) = m22;
    Entry(3,2) = m32;
    Entry(1,3) = m13;
    Entry(2,3) = m23;
    Entry(3,3) = m33;

    Debug(0);
  }

  ~FGMatrix33(void) { Debug(1); }

  double operator()(unsigned int row, unsigned int col) const {
    return Entry(row, col);
  }

  double& operator()(unsigned int row, unsigned int col) {
    return Entry(row, col);
  }

  double Entry(unsigned int row, unsigned int col) const {
    return data[(col-1)*eRows+row-1];
  }

   double& Entry(unsigned int row, unsigned int col) {
     return data[(col-1)*eRows+row-1];
   }

   unsigned int Rows(void) const { return eRows; }

   unsigned int Cols(void) const { return eColumns; }

  FGMatrix33 Transposed(void) const {
    return FGMatrix33( Entry(1,1), Entry(2,1), Entry(3,1),
                       Entry(1,2), Entry(2,2), Entry(3,2),
                       Entry(1,3), Entry(2,3), Entry(3,3) );
  }

  void T(void);

  void InitMatrix(void);

  void InitMatrix(double m11, double m12, double m13,
                  double m21, double m22, double m23,
                  double m31, double m32, double m33) {
    Entry(1,1) = m11;
    Entry(2,1) = m21;
    Entry(3,1) = m31;
    Entry(1,2) = m12;
    Entry(2,2) = m22;
    Entry(3,2) = m32;
    Entry(1,3) = m13;
    Entry(2,3) = m23;
    Entry(3,3) = m33;
  }

  double Determinant(void) const;

  bool Invertible(void) const { return 0.0 != Determinant(); }

  FGMatrix33 Inverse(void) const;

  FGMatrix33& operator=(const FGMatrix33& A) {
    data[0] = A.data[0];
    data[1] = A.data[1];
    data[2] = A.data[2];
    data[3] = A.data[3];
    data[4] = A.data[4];
    data[5] = A.data[5];
    data[6] = A.data[6];
    data[7] = A.data[7];
    data[8] = A.data[8];
    return *this;
  }

  FGColumnVector3 operator*(const FGColumnVector3& v) const;

  FGMatrix33 operator-(const FGMatrix33& B) const;

  FGMatrix33 operator+(const FGMatrix33& B) const;

  FGMatrix33 operator*(const FGMatrix33& B) const;

  FGMatrix33 operator*(const double scalar) const;

  FGMatrix33 operator/(const double scalar) const;

  FGMatrix33& operator-=(const FGMatrix33 &B);

  FGMatrix33& operator+=(const FGMatrix33 &B);

  FGMatrix33& operator*=(const FGMatrix33 &B);

  FGMatrix33& operator*=(const double scalar);

  FGMatrix33& operator/=(const double scalar);

private:
  double data[eRows*eColumns];

  void Debug(int from);
};

inline FGMatrix33 operator*(double scalar, const FGMatrix33& A) {
  // use already defined operation.
  return A*scalar;
}

ostream& operator<<(ostream& os, const FGMatrix33& M);

istream& operator>>(istream& is, FGMatrix33& M);

} // namespace JSBSim

#endif

---