Function vectorToPositionStruct

src/detect_grasps_python.cpp:195–201

}

Position vectorToPositionStruct(const Eigen::Vector3d &v) {
  Position p;
  p.x = v(0);
  p.y = v(1);
  p.z = v(2);
  return p;
}

Quaternion matrixToQuaternionStruct(const Eigen::Matrix3d &rot) {
  Eigen::Quaterniond quat_eig(rot);