liboce-foundation-dev 0.17.1-1 / usr / include / oce / gp_Mat2d.lxx

// Copyright (c) 1995-1999 Matra Datavision
// Copyright (c) 1999-2014 OPEN CASCADE SAS
//
// This file is part of Open CASCADE Technology software library.
//
// This library is free software; you can redistribute it and/or modify it under
// the terms of the GNU Lesser General Public License version 2.1 as published
// by the Free Software Foundation, with special exception defined in the file
// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
// distribution for complete text of the license and disclaimer of any warranty.
//
// Alternatively, this file may be used under the terms of Open CASCADE
// commercial license or contractual agreement.

#include <gp.hxx>
#include <Standard_OutOfRange.hxx>

#define Mat2d00 matrix[0][0]
#define Mat2d01 matrix[0][1]
#define Mat2d10 matrix[1][0]
#define Mat2d11 matrix[1][1]

#define Nat2d00 NewMat2d.matrix[0][0]
#define Nat2d01 NewMat2d.matrix[0][1]
#define Nat2d10 NewMat2d.matrix[1][0]
#define Nat2d11 NewMat2d.matrix[1][1]

#define Oat2d00 Other.matrix[0][0]
#define Oat2d01 Other.matrix[0][1]
#define Oat2d10 Other.matrix[1][0]
#define Oat2d11 Other.matrix[1][1]

inline gp_Mat2d::gp_Mat2d ()
{
  Mat2d00 = Mat2d01 = Mat2d10 = Mat2d11 = 0.0;
}

inline void gp_Mat2d::SetDiagonal (const Standard_Real X1,
			    const Standard_Real X2)
{
  Mat2d00 = X1; Mat2d11 = X2;
}

inline void gp_Mat2d::SetIdentity ()
{
  Mat2d00 = Mat2d11 = 1.0;
  Mat2d01 = Mat2d10 = 0.0;
}

inline void gp_Mat2d::SetRotation (const Standard_Real Ang)
{
  Standard_Real SinA = sin(Ang);
  Standard_Real CosA = cos(Ang);
  Mat2d00 = Mat2d11 = CosA;
  Mat2d01 = -SinA;
  Mat2d10 =  SinA;
}

inline void gp_Mat2d::SetScale (const Standard_Real S)
{
  Mat2d00 = Mat2d11 = S;
  Mat2d01 = Mat2d10 = 0.0;
}

inline void gp_Mat2d::SetValue (const Standard_Integer Row, 
				const Standard_Integer Col, 
				const Standard_Real Value)
{
  Standard_OutOfRange_Raise_if
    (Row < 1 || Row > 2 || Col < 1 || Col > 2, " ");
  matrix[Row-1][Col-1] = Value;
}

inline Standard_Real gp_Mat2d::Determinant () const
{
  return  Mat2d00 * Mat2d11 - Mat2d10 * Mat2d01;
}

inline const Standard_Real& gp_Mat2d::Value (const Standard_Integer Row, 
					     const Standard_Integer Col) const
{
  Standard_OutOfRange_Raise_if
    (Row < 1 || Row > 2 || Col < 1 || Col > 2, " ");
  return matrix[Row-1][Col-1];
}

inline  Standard_Real& 
gp_Mat2d::ChangeValue (const Standard_Integer Row, 
		       const Standard_Integer Col)
{
  Standard_OutOfRange_Raise_if
    (Row < 1 || Row > 2 || Col < 1 || Col > 2, " ");
  return matrix[Row-1][Col-1];
}

inline Standard_Boolean gp_Mat2d::IsSingular () const
{
  Standard_Real det = Determinant();
  if (det < 0) det = - det;
  return det <= gp::Resolution();
}

inline void gp_Mat2d::Add (const gp_Mat2d& Other)
{
  Mat2d00 += Oat2d00;
  Mat2d01 += Oat2d01;
  Mat2d10 += Oat2d10;
  Mat2d11 += Oat2d11;
}

inline gp_Mat2d gp_Mat2d::Added (const gp_Mat2d& Other) const
{
  gp_Mat2d NewMat2d;
  Nat2d00 = Mat2d00 + Oat2d00;
  Nat2d01 = Mat2d01 + Oat2d01;
  Nat2d10 = Mat2d10 + Oat2d10;
  Nat2d11 = Mat2d11 + Oat2d11;
  return NewMat2d;
}

inline void gp_Mat2d::Divide (const Standard_Real Scalar)
{
  Mat2d00 /= Scalar;
  Mat2d01 /= Scalar;
  Mat2d10 /= Scalar;
  Mat2d11 /= Scalar;
}

inline gp_Mat2d gp_Mat2d::Divided (const Standard_Real Scalar) const
{
  gp_Mat2d NewMat2d;
  Nat2d00 = Mat2d00 / Scalar;
  Nat2d01 = Mat2d01 / Scalar;
  Nat2d10 = Mat2d10 / Scalar;
  Nat2d11 = Mat2d11 / Scalar;
  return NewMat2d;
}

inline gp_Mat2d gp_Mat2d::Inverted () const
{
  gp_Mat2d NewMat = *this;
  NewMat.Invert();
  return NewMat;
}

inline gp_Mat2d gp_Mat2d::Multiplied (const gp_Mat2d& Other) const
{
  gp_Mat2d NewMat2d = *this;
  NewMat2d.Multiply(Other);
  return NewMat2d;
}

inline void gp_Mat2d::Multiply (const gp_Mat2d& Other)
{
  Standard_Real T00,T10;
  T00     = Mat2d00 * Oat2d00 + Mat2d01 * Oat2d10;
  T10     = Mat2d10 * Oat2d00 + Mat2d11 * Oat2d10;
  Mat2d01 = Mat2d00 * Oat2d01 + Mat2d01 * Oat2d11;
  Mat2d11 = Mat2d10 * Oat2d01 + Mat2d11 * Oat2d11;
  Mat2d00 = T00;
  Mat2d10 = T10;
}

inline void gp_Mat2d::PreMultiply (const gp_Mat2d& Other)
{
  Standard_Real T00,T01;
  T00     = Oat2d00 * Mat2d00 + Oat2d01 * Mat2d10;
  Mat2d10 = Oat2d10 * Mat2d00 + Oat2d11 * Mat2d10;
  T01     = Oat2d00 * Mat2d01 + Oat2d01 * Mat2d11;
  Mat2d11 = Oat2d10 * Mat2d01 + Oat2d11 * Mat2d11;
  Mat2d00 = T00;
  Mat2d01 = T01;
}

inline gp_Mat2d gp_Mat2d::Multiplied (const Standard_Real Scalar) const
{
  gp_Mat2d NewMat2d;
  Nat2d00 = Mat2d00 * Scalar;
  Nat2d01 = Mat2d01 * Scalar;
  Nat2d10 = Mat2d10 * Scalar;
  Nat2d11 = Mat2d11 * Scalar;
  return NewMat2d;
}

inline void gp_Mat2d::Multiply (const Standard_Real Scalar)
{
  Mat2d00 *= Scalar;
  Mat2d01 *= Scalar;
  Mat2d10 *= Scalar;
  Mat2d11 *= Scalar;
}

inline gp_Mat2d gp_Mat2d::Powered (const Standard_Integer N) const
{
  gp_Mat2d Mat2dN = *this;
  Mat2dN.Power (N);
  return Mat2dN;
}

inline void gp_Mat2d::Subtract (const gp_Mat2d& Other)
{
  Mat2d00 -= Oat2d00;
  Mat2d01 -= Oat2d01;
  Mat2d10 -= Oat2d10;
  Mat2d11 -= Oat2d11;
}

inline gp_Mat2d gp_Mat2d::Subtracted (const gp_Mat2d& Other) const
{
  gp_Mat2d NewMat2d;
  Nat2d00 = Mat2d00 - Oat2d00;
  Nat2d01 = Mat2d01 - Oat2d01;
  Nat2d10 = Mat2d10 - Oat2d10;
  Nat2d11 = Mat2d11 - Oat2d11;
  return NewMat2d;
}

inline void gp_Mat2d::Transpose ()
{
  Standard_Real Temp;
  Temp     = Mat2d01;
  Mat2d01  = Mat2d10;
  Mat2d10  = Temp;
}

inline gp_Mat2d gp_Mat2d::Transposed () const
{
  gp_Mat2d NewMat2d;
  Nat2d10 = Mat2d01;
  Nat2d01 = Mat2d10;
  Nat2d00 = Mat2d00;
  Nat2d11 = Mat2d11;
  return NewMat2d; 
}

inline gp_Mat2d operator* (const Standard_Real Scalar,
			   const gp_Mat2d& Mat2D)
{ return Mat2D.Multiplied (Scalar); }