OCCT

// 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 <GProp.hxx>

#include <gp_Pnt.hxx>
#include <gp_XYZ.hxx>

void GProp::HOperator(

  const gp_Pnt& G,
  const gp_Pnt& Q,
  const double  Mass,
  gp_Mat&       Operator

)
{

  gp_XYZ QG  = G.XYZ() - Q.XYZ();
  double Ixx = QG.Y() * QG.Y() + QG.Z() * QG.Z();
  double Iyy = QG.X() * QG.X() + QG.Z() * QG.Z();
  double Izz = QG.Y() * QG.Y() + QG.X() * QG.X();
  double Ixy = -QG.X() * QG.Y();
  double Iyz = -QG.Y() * QG.Z();
  double Ixz = -QG.X() * QG.Z();
  Operator.SetCols(gp_XYZ(Ixx, Ixy, Ixz), gp_XYZ(Ixy, Iyy, Iyz), gp_XYZ(Ixz, Iyz, Izz));
  Operator.Multiply(Mass);
}