Twist.hpp

Go to the documentation of this file.

#ifndef WBC_TYPES_TWIST_HPP
#define WBC_TYPES_TWIST_HPP
 
#include "Pose.hpp"
 
namespace wbc { namespace types {
 
class Twist{
public:
    Eigen::Vector3d linear;
    Eigen::Vector3d angular;
 
    void setZero(){
        linear.setZero();
        angular.setZero();
    }
 
    Eigen::VectorXd vector6d() const{
        Eigen::VectorXd v(6);
        v.segment(0,3) = linear;
        v.segment(3,3) = angular;
        return v;
    }
};

Twist operator*(const Pose& transform, const Twist& twist_in);

types::Twist operator-(const types::Pose& a, const types::Pose& b);
 
 
}
}
 
#endif