Ejemplo n.º 1
0
 CartPoseErrCalculator(const OR::Transform& pose, RobotAndDOFPtr manip, OR::KinBody::LinkPtr link) :
 pose_inv_(pose.inverse()),
 manip_(manip),
 link_(link)
 {}
Ejemplo n.º 2
0
 CartPoseErrCalculator(const OR::Transform& pose, ConfigurationPtr manip, OR::KinBody::LinkPtr link,Eigen::Vector3d offset) :
   pose_inv_(pose.inverse()),
   manip_(manip),
   link_(link),
   offset_(offset){}