41 namespace bind_transforms
43 Eigen::MatrixXd
getTransform(std::shared_ptr<moveit::core::Transforms>& transforms, std::string& from_frame)
45 auto transform = transforms->getTransform(from_frame);
46 return transform.matrix();
49 std::map<std::string, Eigen::MatrixXd>
getAllTransforms(std::shared_ptr<moveit::core::Transforms>& transforms)
51 std::map<std::string, Eigen::MatrixXd> transforms_map;
52 for (
auto& transform : transforms->getAllTransforms())
54 transforms_map[transform.first] = transform.second.matrix();
56 return transforms_map;
61 py::module transforms = m.def_submodule(
"transforms");
63 py::class_<moveit::core::Transforms, std::shared_ptr<moveit::core::Transforms>>(transforms,
"Transforms",
64 R
"(A snapshot of a transform tree.)")
66 .def(py::init<std::string&>(), R"(Create a new Transforms object.)", py::arg("target_frame"))
71 R
"(Get the transform for from_frame with respect to the target frame.)")
74 R
"(Get all transforms with respect to the target frame.)");