Function reach::createFrame

Defined in File plugin_utils.h

Function Documentation

Eigen::Isometry3d reach::createFrame(const Eigen::Vector3f &pt, const Eigen::Vector3f &norm): Creates a 6-DOF pose from an origin and normal vector, aligning the pose x-axis as closely as possible with the unit x-axis.