motorBaseConfig.hpp

Go to the documentation of this file.

 
#ifndef FCF_DEVMGR_DEVICE_MOTOR_BASE_CONFIG_HPP
#define FCF_DEVMGR_DEVICE_MOTOR_BASE_CONFIG_HPP
 
// System headers
#include <string>
#include <unordered_map>
 
// Third party headers
#include <yaml-cpp/yaml.h>
 
#include <utils/bat/logger.hpp>
#include <fcf/devmgr/devices/motorRpcErrors.hpp>
#include <fcf/devmgr/common/deviceConfig.hpp>
#include <fcf/devmgr/common/dataContext.hpp>
 
 
 
namespace fcf::devmgr::motor {
 
  // Constants for internal mapping
  constexpr auto CI_DEF_VEL               = "velocity";
  constexpr auto CI_MAX_POS               = "max_pos";
  constexpr auto CI_MIN_POS               = "min_pos";
 
 
  constexpr auto CI_TIMEOUT_INIT          = "tout_init";
  constexpr auto CI_TIMEOUT_MOVE          = "tout_move";
  constexpr auto CI_TIMEOUT_SWITCH        = "tout_switch";
 
 
  // WS configuration keywords
  // These configuration only matters for WS level
  constexpr auto CI_POSITIONS             = "positions";
  constexpr auto CI_POS_NAME              = "name";
  constexpr auto CI_POS_VALUE             = "value";
  constexpr auto CI_NAME_POS_TOLERANCE    = "tolerance";
  constexpr auto CI_SCALE_FACTOR          = "scale_factor";
 
 
 
 
  constexpr auto RPC_MOVE_ABS                  = "rpcMoveAbs";
  constexpr auto RPC_MOVE_REL                  = "rpcMoveRel";
  constexpr auto RPC_MOVE_VEL                  = "rpcMoveVel";
 
  constexpr int SUBSTATE_ABORTING              =  107;
  constexpr int SUBSTATE_OP_STANDSTILL         =  216;
  constexpr int SUBSTATE_OP_MOVING             =  217;
  constexpr int SUBSTATE_OP_SETTING_POS        =  218;
  constexpr int SUBSTATE_OP_STOPPING           =  219;
 
  constexpr auto SUBSTATE_READY_STR            =  "Ready";
  constexpr auto SUBSTATE_ABORTING_STR         =  "Aborting";
  constexpr auto SUBSTATE_OP_STANDSTILL_STR    =  "Standstill";
  constexpr auto SUBSTATE_OP_MOVING_STR        =  "Moving";
  constexpr auto SUBSTATE_OP_SETTING_POS_STR   =  "SettingPos";
  constexpr auto SUBSTATE_OP_STOPPING_STR      =  "Stopping";
 
  const std::unordered_map<short, std::string>  SubstateMap = {
    {fcf::devmgr::common::SUBSTATE_NOTREADY,       fcf::devmgr::common::SUBSTATE_NOTREADY_STR},
    {fcf::devmgr::common::SUBSTATE_INITIALISING,   fcf::devmgr::common::SUBSTATE_INITIALISING_STR},
    {fcf::devmgr::common::SUBSTATE_READY,          fcf::devmgr::common::SUBSTATE_READY_STR},
    {fcf::devmgr::common::SUBSTATE_ERROR,          fcf::devmgr::common::SUBSTATE_ERROR_STR},
    {SUBSTATE_ABORTING,       SUBSTATE_ABORTING_STR},
    {SUBSTATE_OP_STANDSTILL,  SUBSTATE_OP_STANDSTILL_STR},
    {SUBSTATE_OP_MOVING,      SUBSTATE_OP_MOVING_STR},
    {SUBSTATE_OP_SETTING_POS, SUBSTATE_OP_SETTING_POS_STR},
    {SUBSTATE_OP_STOPPING,    SUBSTATE_OP_STOPPING_STR},
    {fcf::devmgr::common::SUBSTATE_OP_ERROR,       fcf::devmgr::common::SUBSTATE_OP_ERROR_STR},
  };
 
  // encoders are used only at the WS level
  constexpr auto CI_STAT_ENC_POS              = "pos_enc";
  constexpr auto CI_STAT_TARGET_ENC           = "target_enc";
  constexpr auto CI_STAT_TARGET_POSNAME       = "pos_target_name";
  constexpr auto CI_STAT_ACTUAL_POSNAME       = "pos_actual_name";
  constexpr auto CI_STAT_TARGET_POS           = "pos_target";
  constexpr auto CI_STAT_ACTUAL_POS           = "pos_actual";
  constexpr auto CI_STAT_POS_ERROR            = "pos_error";
  constexpr auto CI_STAT_ACTUAL_VEL           = "vel_actual";
  constexpr auto CI_STAT_TARGET_VEL           = "vel_target";
  constexpr auto CI_STAT_INITIALISED          = "initialised";
 
  constexpr auto FITS_PARAM_POSNAME      = "POSNAME";
  constexpr auto FITS_PARAM_POS          = "POS";
 
 
  constexpr auto UndefinedNamedPos       = "undefined";
 
 
 
 
  // @TODO: replaced by boost bimaps
  // Tried with boost bimap but I've got hundred of errors.
  // I added temporaly two maps.
 
 
  class MotorBaseConfig : public fcf::devmgr::common::DeviceConfig {
    friend class Sensor;
 
 
  public:
    MotorBaseConfig(const std::string filename,
                const std::string name);
 
    MotorBaseConfig(const std::string name);
 
    virtual ~MotorBaseConfig() = default;
 
 
    virtual void Init();
 
 
 
    virtual void GetConfigList(utils::bat::DbVector& cfg_list,
                               std::string prefix) const override;
 
 
 
    inline int GetNumberOfNamedPositions() const noexcept {return m_num_named_pos;};
 
 
    double GetVelocity() const ;
 
    virtual double GetScaleFactor() const;
 
    std::string GetNamedPosition(const int index) const;
 
    double GetNamedPositionValue(const int index) const;
 
    bool FindNamedPositionValue(const std::string named_pos,
                                double& position) const;
 
    bool FindNamedPositionValue(const double position,
                                std::string& name) const;
 
    double GetNpTolerance() const;
 
 
  protected:
 
    // Map of motor named positions
    std::unordered_map<std::string, double> m_named_positions;
    int    m_num_named_pos{0};          
 
  private:
 
    log4cplus::Logger  m_logger;
 
  };
 
}
 
 
#endif //FCF_DEVMGR_DEVICE_MOTOR_BASE_CONFIG_HPP