1s_21_cosserat_rotation.h

/* Copyright (C) 2004-2012 MBSim Development Team
 *
 * This library 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.1 of the License, or (at your option) any later version. 
 *  
 * This library 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 library; if not, write to the Free Software 
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
 *
 * Contact: thomas.cebulla@mytum.de
 */
 
#ifndef _FINITE_ELEMENT_1S_21_COSSERAT_ROTATION_H_
#define _FINITE_ELEMENT_1S_21_COSSERAT_ROTATION_H_
 
#include "mbsimFlexibleBody/discretization_interface.h"
#include "mbsim/mbsim_event.h"
#include "mbsimFlexibleBody/pointer.h"
#include "fmatvec/fmatvec.h"
 
namespace MBSimFlexibleBody {
 
  class FiniteElement1s21CosseratRotation : public DiscretizationInterface {
    public:
 
      FiniteElement1s21CosseratRotation(double l0_,double E_,double G_,double I1_);
 
       ~FiniteElement1s21CosseratRotation() override;       
 
      /* INHERITED INTERFACE OF DISCRETIZATIONINTERFACE */ 
       const fmatvec::SymMat& getM() const override;        
       const fmatvec::Vec& geth() const override;
       const fmatvec::SqrMat& getdhdq() const override;
       const fmatvec::SqrMat& getdhdu() const override;
       int getqSize() const override;
       int getuSize() const override;
 
       void computeM(const fmatvec::Vec& qG) override;
       void computeh(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) override;
       void computedhdz(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) override;
       double computeKineticEnergy(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) override;
       double computeGravitationalEnergy(const fmatvec::Vec& qG) override;
       double computeElasticEnergy(const fmatvec::Vec& qG) override;
 
      virtual fmatvec::Vec3 getPosition(const fmatvec::Vec& qElement, double s);
      virtual fmatvec::SqrMat3 getOrientation(const fmatvec::Vec& qElement, double s);
      virtual fmatvec::Vec3 getVelocity (const fmatvec::Vec& qElement, const fmatvec::Vec& qpElement, double s);
      virtual fmatvec::Vec3 getAngularVelocity(const fmatvec::Vec& qElement, const fmatvec::Vec& qpElement, double s);
      virtual fmatvec::Mat getJacobianOfMotion(const fmatvec::Vec& qElement, double s) { return computeJXqG(qElement,s); }
 
      /* GETTER / SETTER */
      void setCurlRadius(double R1);
      double getl0() const;
 
      fmatvec::Mat computeJXqG(const fmatvec::Vec& qG,double x);
 
    private:
      double l0;
 
      double E;
 
      double G;
 
      double I1;
 
      double k10;
 
      fmatvec::Vec h;
 
      fmatvec::Vec X;
 
      fmatvec::SqrMat dhdq, dhdu;
 
 
      FiniteElement1s21CosseratRotation(); // standard constructor
      FiniteElement1s21CosseratRotation(const FiniteElement1s21CosseratRotation&); // copy constructor
      FiniteElement1s21CosseratRotation& operator=(const FiniteElement1s21CosseratRotation&); // assignment operator
  };
 
  inline const fmatvec::SymMat& FiniteElement1s21CosseratRotation::getM() const { throw std::runtime_error("(FiniteElement1s21CosseratRotation::getM): Not implemented");  }
  inline const fmatvec::Vec& FiniteElement1s21CosseratRotation::geth() const { return h; }
  inline const fmatvec::SqrMat& FiniteElement1s21CosseratRotation::getdhdq() const { return dhdq; }
  inline const fmatvec::SqrMat& FiniteElement1s21CosseratRotation::getdhdu() const { return dhdu; }
  inline int FiniteElement1s21CosseratRotation::getqSize() const { return 4; }
  inline int FiniteElement1s21CosseratRotation::getuSize() const { return 4; }
  inline void  FiniteElement1s21CosseratRotation::computeM(const fmatvec::Vec& qG) { throw std::runtime_error("(FiniteElement1s21CosseratRotation::computeM): Not implemented"); }
  inline void  FiniteElement1s21CosseratRotation::computedhdz(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) { throw std::runtime_error("(FiniteElement1s21CosseratRotation::computedhdz): Not implemented"); }
  inline double FiniteElement1s21CosseratRotation::computeKineticEnergy(const fmatvec::Vec& qG, const fmatvec::Vec& qGt) { throw std::runtime_error("(FiniteElement1s21CosseratRotation::computeKineticEnergy): Not implemented"); }
  inline double FiniteElement1s21CosseratRotation::computeGravitationalEnergy(const fmatvec::Vec& qG) { throw std::runtime_error("(FiniteElement1s21CosseratRotation::computeGravitationalEnergy): Not implemented"); }
  inline double FiniteElement1s21CosseratRotation::getl0() const { return l0; }
 
}
 
#endif /* _FINITE_ELEMENT_1S_21_COSSERAT_ROTATION_H_ */