CycloidalPropeller.h

#ifndef CycloidalPropeller_h_
#define CycloidalPropeller_h_
#include <cmath>
#include <memory>
#include <string>
 
#include <Eigen/Eigen>
#include <sfh/constants.h>
 
#include <fhsim/simobject/SimObject.h>
#include <fhsim_environment/EnvironmentProvider.h>
#include "PropulsorWakeField.h"
 
namespace Ship{
 
   struct CycloidalWakeState {
      EIGEN_MAKE_ALIGNED_OPERATOR_NEW
      Eigen::Quaterniond Q                = Eigen::Quaterniond::Identity();
      double             current          = 0;
      Eigen::Vector3d    thrustVectorBody = Eigen::Vector3d::UnitX();
      Eigen::Vector3d    posNED           = Eigen::Vector3d::Zero();
   };
 
   using CycloidalPropellerCurrentField = PropulsorWakeField<CycloidalWakeState>;
 
    class CycloidalPropeller: public SimObject{
    public:
        EIGEN_MAKE_ALIGNED_OPERATOR_NEW
        CycloidalPropeller(const std::string simObjectName, ISimObjectCreator* const creator);
        void Compute(const double T, const double * const X) const;
        void OdeFcn(const double T, const double *const X, double *const XDot) const;
           void PreOdeFcn(const double T, const double *const X);
        void AcceptedStep(double T, const double* X) override;
 
        const double * ForceNED(const double T, const double * const X);
        const double * TorqueNED(const double T, const double * const X);
 
        const double * ForceBody(const double T, const double * const X);
        const double * TorqueBody(const double T, const double * const X);
 
        const double* ShaftTorqueCorrectedBody(const double T, const double* const X);
        const double* ShaftTorqueBody(const double T, const double* const X);
 
        const double* ShaftPowerCorrected(const double T, const double* const X);
        const double* ShaftPower(const double T, const double* const X);
 
        void FinalSetup(const double T, const double *const X, ISimObjectCreator* const creator);
    #ifdef FH_VISUALIZATION
        void RenderInit(Ogre::Root* const ogreRoot, ISimObjectCreator* const creator);
        void RenderUpdate(const double T, const double* const X);
    #endif
    private:
 
        double Ct ( double intensity )const{
            return std::pow(std::sin( intensity*sfh::pi/2 ),2.0);
        }
 
    #ifdef FH_VISUALIZATION
        int m_rotationState;
        bool m_reverseRotationDirection;
 
        Ogre::SceneNode *m_RenderNode;
        Ogre::SceneNode *m_RenderNodeFoil;
    #endif
 
        int m_currentState;
        double m_ct;
        mutable double m_ct_angle;
        double m_cq;
        mutable double m_cq_angle;
        double m_D;
        double m_b;
 
        mutable double m_shaftTorque;
        mutable double m_shaftPower;
 
 
        double m_torqueScale;
        double m_thrustScale;
 
        mutable Eigen::Vector3d m_force;
        mutable Eigen::Vector3d m_torque;
 
        mutable Eigen::Vector3d m_forceBody;
        mutable Eigen::Vector3d m_torqueBody;
 
        ICommonComputation * m_compute;
 
        ISignalPort * m_inRPM;
        ISignalPort * m_inThrustIntensity;
        ISignalPort * m_inThrustVectorBody;
 
        ISignalPort * m_inPositionNED;
        ISignalPort * m_inVelocityNED;
        ISignalPort * m_inOrientationNED;
 
        environment::EnvironmentProvider *m_environment = nullptr;
                std::shared_ptr<CycloidalPropellerCurrentField> m_currentField; 
 
    };
}
#endif // CycloidalPropeller_h__