ConeTruncated.hpp

Go to the documentation of this file.

// This file is part of GranOO, a workbench for DEM simulation.
//
// Author(s)    : - Damien Andre       IRCER/UNILIM, Limoges France
//                  <damien.andre@unilim.fr>
//                - Jean-luc Charles   Arts et Metiers ParisTech, CNRS, I2M, Bordeaux France
//                  <jean-luc.charles@ensam.eu>
//                - Jeremie Girardot   Arts et Metiers ParisTech, CNRS, I2M, Bordeaux France
//                  <jeremie.girardot@ensam.eu>
//                - Cedric Hubert      LAMIH/UPHF, Valenciennes France
//                  <cedric.hubert@uphf.fr>
//                - Ivan Iordanoff     Arts et Metiers ParisTech, CNRS, I2M, Bordeaux France
//                  <ivan.iordanoff@ensam.eu>
//
// Copyright (C) 2008-2019 D. Andre, JL. Charles, J. Girardot, C. Hubert, I. Iordanoff
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, either version 3 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 General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program.  If not, see <http://www.gnu.org/licenses/>.
 
 
#ifndef _GranOO_LibShape_ConeTruncated_hh_
#define _GranOO_LibShape_ConeTruncated_hh_
 
#include <iostream>
#include <string>
 
#include <vtkUnstructuredGrid.h>
 
#include "GranOO3/Geom/Point.hpp"
#include "GranOO3/Shape/Volume.hpp"
#include "GranOO3/Core/String.hpp"
 
namespace GranOO3 {
 
namespace Shape {
 
    class Sphere;
    class ConeTruncated : public Volume, public Core::ObjectFactoryInterface<Base, ConeTruncated> {
 
      GRANOO_OBJECT_FACTORY(ConeTruncated);
 
    private:
      enum ContactRegion {
        XMIN   = 1 << 0,
        RADIUS = 1 << 1,
        XMAX   = 1 << 2,
      };
 
    public:
      static std::string class_ID() {return std::string("ConeTruncated");}
      static std::string desc();
 
    public:
      //CONSTRUCTORS & DESTRUCTORS
      ConeTruncated();
      ConeTruncated(double radius1, double radius2, double length, const Geom::Frame& frame);
      ConeTruncated(const ConeTruncated &);
      ConeTruncated(const ConeTruncated &, const Geom::Frame&);
      ConeTruncated(const Geom::Frame& frame);
      virtual ~ConeTruncated();
 
      //IO
      void read_xml_element(const TiXmlElement* el);
      virtual std::ostream& write_ascii (std::ostream& out) const;
      virtual std::istream& read_ascii (std::istream& in);
      virtual void to_vtk(vtkUnstructuredGrid* data);
      std::string info() const;
 
      //CLONING
      void make_equal_to(const ConeTruncated&);
 
      //BOUNDING SHAPE
      void update_bounding_box();
      void update_bounding_sphere();
      double get_greatest_dimension() const;
      AABB aabb() const;
 
      //CONTACT DETECTION
      Interference locate(const Geom::Point&) const;
      Interference locate(const Geom::Point&, double radius) const;
      void set_contact_regions(const std::string &regions);
 
      //CONTACT DETECTION v2
      GRANOO_DECLARE_SHAPE_COLLISION();
      bool collide_inside(const Geom::Point& p1, double radius, Collision::Data& info) const;
      bool collide_outside(const Geom::Point& p1, double radius, Collision::Data& info) const;
      Geom::Point farthest_point_along(const Geom::Vector&) const;
 
      //USEFULL
      double get_volume() const;
      void compute_inertia_tensor(double density, Geom::Tensor &) const;
      double get_half_angle() const {
        return atan((_radius1-_radius2)/_length);
      }
 
      void draw_gl() const;
      void scale(double);
 
      //ACCESSORS
      GRANOO_ACCESS_SHAPE_DIM(radius1, double, _radius1);
      GRANOO_ACCESS_SHAPE_DIM(radius2, double, _radius2);
      GRANOO_ACCESS_SHAPE_DIM(length, double, _length);
      double get_radius_at(double) const;
      double get_centre_of_mass() const;
 
      std::ostream& to_povray (std::ostream& out, const Core::Color& ) const;
 
    private:
      ConeTruncated & operator=(const ConeTruncated &); //Not allowed
 
      //SERIALIZATION
      friend class boost::serialization::access;
      template<class Archive> void serialize(Archive&, const unsigned int);
 
    private:
      double _radius1;
      double _radius2;
      double _length;
      Box*    _bounding_box;
      Sphere* _bounding_sphere;
      ContactRegion _cRegion;
    };
 
  inline
    ConeTruncated::ConeTruncated(double radius1, double radius2, double length, const Geom::Frame& frame)
      : Volume(frame),
      _radius1(radius1),
      _radius2(radius2),
      _length(length),
      _bounding_box(0),
      _bounding_sphere(0),
      _cRegion(ContactRegion(XMIN | RADIUS | XMAX)) {
 
      set_face_ID("xMin", "radius", "vertex");
      SafeModeAssert(_radius1>=0, "bad input value");
      SafeModeAssert(_radius2>=0, "bad input value");
      SafeModeAssert(_radius1>=_radius2, "bad input value");
      SafeModeAssert(_length>=0, "bad input value");
    }
 
    inline
    ConeTruncated::ConeTruncated() : ConeTruncated(0., 0., 0., Geom::Frame::global) {
 
    }
 
    inline
    ConeTruncated::ConeTruncated(const ConeTruncated &s, const Geom::Frame& frame) : ConeTruncated(s._radius1, s._radius2, s._length, frame) {
 
    }
 
    inline
    ConeTruncated::ConeTruncated(const ConeTruncated &s) : ConeTruncated(s._radius1, s._radius2, s._length, s._frame ) {
 
    }
 
    inline
    ConeTruncated::ConeTruncated(const Geom::Frame& frame) : ConeTruncated(0., 0., 0., frame) {
 
    }
 
    inline double
    ConeTruncated::get_volume() const {
 
      return _length*M_PI*(pow(_radius1, 2)+pow(_radius2, 2)+_radius1*_radius2)/3.;
    }
 
    inline double
    ConeTruncated::get_greatest_dimension() const {
 
      double max = get_radius1()*2.;
      if (get_length() > max)
        max = get_length();
 
      return max;
    }
 
    inline
    AABB ConeTruncated::aabb() const {
 
      double xMin = farthest_point_along(Geom::Vector(-1,  0,  0)).x();
      double xMax = farthest_point_along(Geom::Vector( 1,  0,  0)).x();
      double yMin = farthest_point_along(Geom::Vector( 0, -1,  0)).y();
      double yMax = farthest_point_along(Geom::Vector( 0,  1,  0)).y();
      double zMin = farthest_point_along(Geom::Vector( 0,  0, -1)).z();
      double zMax = farthest_point_along(Geom::Vector( 0,  0,  1)).z();
 
      double minPoint[] = { xMin, yMin, zMin };
      double maxPoint[] = { xMax, yMax, zMax };
 
      return StaticAABBTree::new_lonely_aabb(minPoint, maxPoint);
    }
 
    inline double
    ConeTruncated::get_radius_at(double x) const {
 
      x += get_centre_of_mass();
      return _radius1 - ((_radius1-_radius2)/_length)*x;
    }
 
    template<class Archive>
    inline void
    ConeTruncated::serialize(Archive& ar, const unsigned int) {
 
      ar & boost::serialization::base_object<Volume>(*this);
      ar & _radius1;
      ar & _radius2;
      ar & _length;
      ar & _cRegion;
    }
  }
}
 
//Don't forget to export for dynamic serialization of child class
#include <boost/serialization/export.hpp>
BOOST_CLASS_EXPORT_KEY(GranOO3::Shape::ConeTruncated)
 
#include <boost/serialization/version.hpp>
BOOST_CLASS_VERSION(GranOO3::Shape::ConeTruncated,0)
GRANOO_SERIALIZE_SHAPE(ConeTruncated)
 
namespace GranOO3 {
 
  extern template class Core::ObjectFactoryInterface<Shape::Base, Shape::ConeTruncated>;
}
 
#endif