30 #ifndef EXOTICA_CORE_TASK_MAPS_POINT_TO_LINE_H_ 31 #define EXOTICA_CORE_TASK_MAPS_POINT_TO_LINE_H_ 35 #include <exotica_core_task_maps/point_to_line_initializer.h> 46 void Instantiate(
const PointToLineInitializer& init)
override;
59 Eigen::Vector3d
Direction(
const Eigen::Vector3d& point);
77 #endif // EXOTICA_CORE_TASK_MAPS_POINT_TO_LINE_H_ Eigen::Vector3d line_
vector from start to end point of line
Eigen::Vector3d line_end_
end point of line in base frame
std::string link_name_
frame of defined point
Eigen::Vector3d Direction(const Eigen::Vector3d &point)
direction computes the vector from a point to its projection on a line
Eigen::Vector3d line_start_
start point of line in base frame
Eigen::Ref< Eigen::VectorXd > VectorXdRef
EIGEN_MAKE_ALIGNED_OPERATOR_NEW PointToLine()
int TaskSpaceDim() override
std::string base_name_
frame of defined line
void Update(Eigen::VectorXdRefConst x, Eigen::VectorXdRef phi) override
ros::Publisher pub_marker_label_
marker label
ros::Publisher pub_marker_
publish marker for RViz
const Eigen::Ref< const Eigen::VectorXd > & VectorXdRefConst
void Instantiate(const PointToLineInitializer &init) override
Eigen::Ref< Eigen::MatrixXd > MatrixXdRef
Eigen::Vector3d GetEndPoint()
void SetEndPoint(const Eigen::Vector3d &point)