/* * Copyright (c) 2011-2022, The DART development contributors * All rights reserved. * * The list of contributors can be found at: * https://github.com/dartsim/dart/blob/master/LICENSE * * This file is provided under the following "BSD-style" License: * Redistribution and use in source and binary forms, with or * without modification, are permitted provided that the following * conditions are met: * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include "eigen_geometry_pybind.h" #include "eigen_pybind.h" namespace py = pybind11; namespace dart { namespace python { void ReferentialSkeleton(py::module& m) { ::py::class_< dart::dynamics::ReferentialSkeleton, dart::dynamics::MetaSkeleton, std::shared_ptr>( m, "ReferentialSkeleton") .def( "getLockableReference", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::unique_ptr { return self->getLockableReference(); }) .def( "setName", +[](dart::dynamics::ReferentialSkeleton* self, const std::string& _name) -> const std::string& { return self->setName(_name); }, ::py::return_value_policy::reference_internal, ::py::arg("name")) .def( "getName", +[](const dart::dynamics::ReferentialSkeleton* self) -> const std::string& { return self->getName(); }, ::py::return_value_policy::reference_internal) .def( "getNumSkeletons", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::size_t { return self->getNumSkeletons(); }) .def( "hasSkeleton", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Skeleton* skel) -> bool { return self->hasSkeleton(skel); }, ::py::arg("skel")) .def( "getNumBodyNodes", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::size_t { return self->getNumBodyNodes(); }) .def( "getBodyNodes", +[](dart::dynamics::ReferentialSkeleton* self) -> const std::vector& { return self->getBodyNodes(); }) .def( "getBodyNodes", +[](dart::dynamics::ReferentialSkeleton* self, const std::string& name) -> std::vector { return self->getBodyNodes(name); }, ::py::arg("name")) .def( "getBodyNodes", +[](const dart::dynamics::ReferentialSkeleton* self, const std::string& name) -> std::vector { return self->getBodyNodes(name); }, ::py::arg("name")) .def( "hasBodyNode", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::BodyNode* bodyNode) -> bool { return self->hasBodyNode(bodyNode); }, ::py::arg("bodyNode")) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::BodyNode* _bn) -> std::size_t { return self->getIndexOf(_bn); }, ::py::arg("bn")) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::BodyNode* _bn, bool _warning) -> std::size_t { return self->getIndexOf(_bn, _warning); }, ::py::arg("bn"), ::py::arg("warning")) .def( "getNumJoints", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::size_t { return self->getNumJoints(); }) .def( "getJoints", +[](dart::dynamics::ReferentialSkeleton* self) -> std::vector { return self->getJoints(); }) .def( "getJoints", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::vector { return self->getJoints(); }) .def( "getJoints", +[](dart::dynamics::ReferentialSkeleton* self, const std::string& name) -> std::vector { return self->getJoints(name); }, ::py::arg("name")) .def( "getJoints", +[](const dart::dynamics::ReferentialSkeleton* self, const std::string& name) -> std::vector { return self->getJoints(name); }, ::py::arg("name")) .def( "hasJoint", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Joint* joint) -> bool { return self->hasJoint(joint); }, ::py::arg("joint")) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Joint* _joint) -> std::size_t { return self->getIndexOf(_joint); }, ::py::arg("joint")) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Joint* _joint, bool _warning) -> std::size_t { return self->getIndexOf(_joint, _warning); }, ::py::arg("joint"), ::py::arg("warning")) .def( "getNumDofs", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::size_t { return self->getNumDofs(); }) .def( "getDofs", +[](const dart::dynamics::ReferentialSkeleton* self) -> std::vector { return self->getDofs(); }) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::DegreeOfFreedom* _dof) -> std::size_t { return self->getIndexOf(_dof); }, ::py::arg("dof")) .def( "getIndexOf", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::DegreeOfFreedom* _dof, bool _warning) -> std::size_t { return self->getIndexOf(_dof, _warning); }, ::py::arg("dof"), ::py::arg("warning")) .def( "getJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::Jacobian { return self->getJacobian(_node); }, ::py::arg("node")) .def( "getJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobian(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::Jacobian { return self->getJacobian(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobian(_node, _localOffset, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("localOffset"), ::py::arg("inCoordinatesOf")) .def( "getWorldJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::Jacobian { return self->getWorldJacobian(_node); }, ::py::arg("node")) .def( "getWorldJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::Jacobian { return self->getWorldJacobian(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::LinearJacobian { return self->getLinearJacobian(_node); }, ::py::arg("node")) .def( "getLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getLinearJacobian(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::LinearJacobian { return self->getLinearJacobian(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getLinearJacobian( _node, _localOffset, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("localOffset"), ::py::arg("inCoordinatesOf")) .def( "getAngularJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::AngularJacobian { return self->getAngularJacobian(_node); }, ::py::arg("node")) .def( "getAngularJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::AngularJacobian { return self->getAngularJacobian(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::Jacobian { return self->getJacobianSpatialDeriv(_node); }, ::py::arg("node")) .def( "getJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobianSpatialDeriv(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::Jacobian { return self->getJacobianSpatialDeriv(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobianSpatialDeriv( _node, _localOffset, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("localOffset"), ::py::arg("inCoordinatesOf")) .def( "getJacobianClassicDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::Jacobian { return self->getJacobianClassicDeriv(_node); }, ::py::arg("node")) .def( "getJacobianClassicDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobianClassicDeriv(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getJacobianClassicDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::Jacobian { return self->getJacobianClassicDeriv(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getJacobianClassicDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getJacobianClassicDeriv( _node, _localOffset, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("localOffset"), ::py::arg("inCoordinatesOf")) .def( "getLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::LinearJacobian { return self->getLinearJacobianDeriv(_node); }, ::py::arg("node")) .def( "getLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getLinearJacobianDeriv(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset) -> dart::math::LinearJacobian { return self->getLinearJacobianDeriv(_node, _localOffset); }, ::py::arg("node"), ::py::arg("localOffset")) .def( "getLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const Eigen::Vector3d& _localOffset, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getLinearJacobianDeriv( _node, _localOffset, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("localOffset"), ::py::arg("inCoordinatesOf")) .def( "getAngularJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node) -> dart::math::AngularJacobian { return self->getAngularJacobianDeriv(_node); }, ::py::arg("node")) .def( "getAngularJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::JacobianNode* _node, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::AngularJacobian { return self->getAngularJacobianDeriv(_node, _inCoordinatesOf); }, ::py::arg("node"), ::py::arg("inCoordinatesOf")) .def( "getMass", +[](const dart::dynamics::ReferentialSkeleton* self) -> double { return self->getMass(); }) .def( "clearExternalForces", +[](dart::dynamics::ReferentialSkeleton* self) { self->clearExternalForces(); }) .def( "clearInternalForces", +[](dart::dynamics::ReferentialSkeleton* self) { self->clearInternalForces(); }) .def( "computeKineticEnergy", +[](const dart::dynamics::ReferentialSkeleton* self) -> double { return self->computeKineticEnergy(); }) .def( "computePotentialEnergy", +[](const dart::dynamics::ReferentialSkeleton* self) -> double { return self->computePotentialEnergy(); }) // .def( // "clearCollidingBodies", // +[](dart::dynamics::ReferentialSkeleton* self) { // self->clearCollidingBodies(); // }) .def( "getCOM", +[](const dart::dynamics::ReferentialSkeleton* self) -> Eigen::Vector3d { return self->getCOM(); }) .def( "getCOM", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _withRespectTo) -> Eigen::Vector3d { return self->getCOM(_withRespectTo); }, ::py::arg("withRespectTo")) .def( "getCOMSpatialVelocity", +[](const dart::dynamics::ReferentialSkeleton* self) -> Eigen::Vector6d { return self->getCOMSpatialVelocity(); }) .def( "getCOMSpatialVelocity", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo) -> Eigen::Vector6d { return self->getCOMSpatialVelocity(_relativeTo); }, ::py::arg("relativeTo")) .def( "getCOMSpatialVelocity", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo, const dart::dynamics::Frame* _inCoordinatesOf) -> Eigen::Vector6d { return self->getCOMSpatialVelocity(_relativeTo, _inCoordinatesOf); }, ::py::arg("relativeTo"), ::py::arg("inCoordinatesOf")) .def( "getCOMLinearVelocity", +[](const dart::dynamics::ReferentialSkeleton* self) -> Eigen::Vector3d { return self->getCOMLinearVelocity(); }) .def( "getCOMLinearVelocity", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo) -> Eigen::Vector3d { return self->getCOMLinearVelocity(_relativeTo); }, ::py::arg("relativeTo")) .def( "getCOMLinearVelocity", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo, const dart::dynamics::Frame* _inCoordinatesOf) -> Eigen::Vector3d { return self->getCOMLinearVelocity(_relativeTo, _inCoordinatesOf); }, ::py::arg("relativeTo"), ::py::arg("inCoordinatesOf")) .def( "getCOMSpatialAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self) -> Eigen::Vector6d { return self->getCOMSpatialAcceleration(); }) .def( "getCOMSpatialAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo) -> Eigen::Vector6d { return self->getCOMSpatialAcceleration(_relativeTo); }, ::py::arg("relativeTo")) .def( "getCOMSpatialAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo, const dart::dynamics::Frame* _inCoordinatesOf) -> Eigen::Vector6d { return self->getCOMSpatialAcceleration( _relativeTo, _inCoordinatesOf); }, ::py::arg("relativeTo"), ::py::arg("inCoordinatesOf")) .def( "getCOMLinearAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self) -> Eigen::Vector3d { return self->getCOMLinearAcceleration(); }) .def( "getCOMLinearAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo) -> Eigen::Vector3d { return self->getCOMLinearAcceleration(_relativeTo); }, ::py::arg("relativeTo")) .def( "getCOMLinearAcceleration", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _relativeTo, const dart::dynamics::Frame* _inCoordinatesOf) -> Eigen::Vector3d { return self->getCOMLinearAcceleration( _relativeTo, _inCoordinatesOf); }, ::py::arg("relativeTo"), ::py::arg("inCoordinatesOf")) .def( "getCOMJacobian", +[](const dart::dynamics::ReferentialSkeleton* self) -> dart::math::Jacobian { return self->getCOMJacobian(); }) .def( "getCOMJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getCOMJacobian(_inCoordinatesOf); }, ::py::arg("inCoordinatesOf")) .def( "getCOMLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self) -> dart::math::LinearJacobian { return self->getCOMLinearJacobian(); }) .def( "getCOMLinearJacobian", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getCOMLinearJacobian(_inCoordinatesOf); }, ::py::arg("inCoordinatesOf")) .def( "getCOMJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self) -> dart::math::Jacobian { return self->getCOMJacobianSpatialDeriv(); }) .def( "getCOMJacobianSpatialDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::Jacobian { return self->getCOMJacobianSpatialDeriv(_inCoordinatesOf); }, ::py::arg("inCoordinatesOf")) .def( "getCOMLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self) -> dart::math::LinearJacobian { return self->getCOMLinearJacobianDeriv(); }) .def( "getCOMLinearJacobianDeriv", +[](const dart::dynamics::ReferentialSkeleton* self, const dart::dynamics::Frame* _inCoordinatesOf) -> dart::math::LinearJacobian { return self->getCOMLinearJacobianDeriv(_inCoordinatesOf); }, ::py::arg("inCoordinatesOf")); } } // namespace python } // namespace dart