Mass.h

#ifndef OBJECT_MASS_H
#define OBJECT_MASS_H

#include <KrisLibrary/geometry/AnyGeometry.h>
using namespace Math3D;


Vector3 CenterOfMass(const Meshing::TriMesh& mesh);
Vector3 CenterOfMass(const Meshing::PointCloud3D& pc);
Vector3 CenterOfMass(const Meshing::VolumeGrid& grid);
Vector3 CenterOfMass(const Geometry::AnyGeometry3D& geom);

Matrix3 Covariance(const Meshing::TriMesh& mesh,const Vector3& center);
Matrix3 Covariance(const Meshing::PointCloud3D& pc,const Vector3& center);
Matrix3 Covariance(const Meshing::VolumeGrid& vol,const Vector3& center);
Matrix3 Covariance(const Geometry::AnyGeometry3D& geom,const Vector3& center);
inline Matrix3 Covariance(const Meshing::TriMesh& mesh) { return Covariance(mesh,CenterOfMass(mesh)); }
inline Matrix3 Covariance(const Meshing::PointCloud3D& mesh) { return Covariance(mesh,CenterOfMass(mesh)); }
inline Matrix3 Covariance(const Meshing::VolumeGrid& mesh) { return Covariance(mesh,CenterOfMass(mesh)); }
inline Matrix3 Covariance(const Geometry::AnyGeometry3D& mesh) { return Covariance(mesh,CenterOfMass(mesh)); }

Matrix3 Inertia(const Meshing::TriMesh& mesh,const Vector3& center,Real mass);
Matrix3 Inertia(const Meshing::PointCloud3D& mesh,const Vector3& center,Real mass);
Matrix3 Inertia(const Meshing::VolumeGrid& mesh,const Vector3& center,Real mass);
Matrix3 Inertia(const Geometry::AnyGeometry3D& mesh,const Vector3& center,Real mass);
inline Matrix3 Inertia(const Meshing::TriMesh& mesh,Real mass) { return Inertia(mesh,CenterOfMass(mesh),mass); }
inline Matrix3 Inertia(const Meshing::PointCloud3D& mesh,Real mass) { return Inertia(mesh,CenterOfMass(mesh),mass); }
inline Matrix3 Inertia(const Meshing::VolumeGrid& mesh,Real mass) { return Inertia(mesh,CenterOfMass(mesh),mass); }
inline Matrix3 Inertia(const Geometry::AnyGeometry3D& mesh,Real mass) { return Inertia(mesh,CenterOfMass(mesh),mass); }

Vector3 CenterOfMass_Solid(const Meshing::TriMesh& mesh,Real gridRes);
Matrix3 Covariance_Solid(const Meshing::TriMesh& mesh,Real gridRes,const Vector3& center);
inline Matrix3 Covariance_Solid(const Meshing::TriMesh& mesh,Real gridRes)
{
  return Covariance_Solid(mesh,gridRes,CenterOfMass_Solid(mesh,gridRes));
}
Matrix3 Inertia_Solid(const Meshing::TriMesh& mesh,Real gridRes,const Vector3& center,Real mass);
inline Matrix3 Inertia_Solid(const Meshing::TriMesh& mesh,Real gridRes,Real mass)
{
  return Inertia_Solid(mesh,gridRes,CenterOfMass_Solid(mesh,gridRes),mass);
}

#endif