model.hpp

Go to the documentation of this file.

 
#ifndef FLEXIV_RDK_MODEL_HPP_
#define FLEXIV_RDK_MODEL_HPP_
 
#include "robot.hpp"
#include <Eigen/Eigen>
#include <memory>
 
namespace flexiv {
namespace rdk {
 
class Model
{
public:
    Model(const Robot& robot,
        const Eigen::Vector3d& gravity_vector = Eigen::Vector3d(0.0, 0.0, -9.81));
    virtual ~Model();
 
    std::vector<std::string> link_names() const;
 
    void Reload();
 
    void Update(const std::vector<double>& positions, const std::vector<double>& velocities);
 
    //========================================== DYNAMICS ==========================================
    Eigen::MatrixXd dJ(const std::string& link_name);
 
    Eigen::MatrixXd M();
 
    Eigen::MatrixXd C();
 
    Eigen::VectorXd g();
 
    Eigen::VectorXd c();
 
    //========================================= KINEMATICS =========================================
    Eigen::MatrixXd J(const std::string& link_name);
 
    Eigen::Isometry3d T(const std::string& link_name);
 
    void SyncURDF(const std::string& template_urdf_path);
 
    std::pair<bool, std::vector<double>> reachable(const std::array<double, kPoseSize>& pose,
        const std::vector<double>& seed_positions, bool free_orientation) const;
 
    std::pair<double, double> configuration_score() const;
 
private:
    class Impl;
    std::unique_ptr<Impl> pimpl_;
};
 
} /* namespace rdk */
} /* namespace flexiv */
 
#endif /* FLEXIV_RDK_MODEL_HPP_ */