Debian Codegraph @

python/dartpy/dynamics/Chain.cpp

raw
1 /*
2 * Copyright (c) 2011-2022, The DART development contributors
3 * All rights reserved.
4 *
5 * The list of contributors can be found at:
6 * https://github.com/dartsim/dart/blob/master/LICENSE
7 *
8 * This file is provided under the following "BSD-style" License:
9 * Redistribution and use in source and binary forms, with or
10 * without modification, are permitted provided that the following
11 * conditions are met:
12 * * Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * * Redistributions in binary form must reproduce the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer in the documentation and/or other materials provided
17 * with the distribution.
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
19 * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
20 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
21 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
23 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
24 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
25 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
26 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include <dart/dart.hpp>
34 #include <pybind11/pybind11.h>
35
36 #include "eigen_geometry_pybind.h"
37 #include "eigen_pybind.h"
38
39 namespace py = pybind11;
40
41 namespace dart {
42 namespace python {
43
44 void Chain(py::module& m)
45 {
46 ::py::class_<
47 dart::dynamics::Chain,
48 dart::dynamics::Linkage,
49 std::shared_ptr<dart::dynamics::Chain>>(m, "Chain")
50 .def(
51 ::py::init(
52 +[](const dart::dynamics::Chain::Criteria& criteria)
53 -> dart::dynamics::ChainPtr {
54 return dart::dynamics::Chain::create(criteria);
55 }),
56 ::py::arg("criteria"))
57 .def(
58 ::py::init(
59 +[](const dart::dynamics::Chain::Criteria& criteria,
60 const std::string& name) -> dart::dynamics::ChainPtr {
61 return dart::dynamics::Chain::create(criteria, name);
62 }),
63 ::py::arg("criteria"),
64 ::py::arg("name"))
65 .def(
66 ::py::init(
67 +[](dart::dynamics::BodyNode* start,
68 dart::dynamics::BodyNode* target)
69 -> dart::dynamics::ChainPtr {
70 return dart::dynamics::Chain::create(start, target);
71 }),
72 ::py::arg("start"),
73 ::py::arg("target"))
74 .def(
75 ::py::init(
76 +[](dart::dynamics::BodyNode* start,
77 dart::dynamics::BodyNode* target,
78 const std::string& name) -> dart::dynamics::ChainPtr {
79 return dart::dynamics::Chain::create(start, target, name);
80 }),
81 ::py::arg("start"),
82 ::py::arg("target"),
83 ::py::arg("name"))
84 .def(
85 ::py::init(
86 +[](dart::dynamics::BodyNode* start,
87 dart::dynamics::BodyNode* target,
88 bool includeUpstreamParentJoint) -> dart::dynamics::ChainPtr {
89 if (includeUpstreamParentJoint)
90 return dart::dynamics::Chain::create(
91 start,
92 target,
93 dart::dynamics::Chain::IncludeUpstreamParentJoint);
94 else
95 return dart::dynamics::Chain::create(start, target);
96 }),
97 ::py::arg("start"),
98 ::py::arg("target"),
99 ::py::arg("includeUpstreamParentJoint"))
100 .def(
101 ::py::init(
102 +[](dart::dynamics::BodyNode* start,
103 dart::dynamics::BodyNode* target,
104 bool includeUpstreamParentJoint,
105 const std::string& name) -> dart::dynamics::ChainPtr {
106 if (includeUpstreamParentJoint)
107 return dart::dynamics::Chain::create(
108 start,
109 target,
110 dart::dynamics::Chain::IncludeUpstreamParentJoint,
111 name);
112 else
113 return dart::dynamics::Chain::create(start, target, name);
114 }),
115 ::py::arg("start"),
116 ::py::arg("target"),
117 ::py::arg("includeUpstreamParentJoint"),
118 ::py::arg("name"))
119 .def(
120 "cloneChain",
121 +[](const dart::dynamics::Chain* self) -> dart::dynamics::ChainPtr {
122 return self->cloneChain();
123 })
124 .def(
125 "cloneChain",
126 +[](const dart::dynamics::Chain* self,
127 const std::string& cloneName) -> dart::dynamics::ChainPtr {
128 return self->cloneChain(cloneName);
129 },
130 ::py::arg("cloneName"))
131 .def(
132 "cloneMetaSkeleton",
133 +[](const dart::dynamics::Chain* self,
134 const std::string& cloneName) -> dart::dynamics::MetaSkeletonPtr {
135 return self->cloneMetaSkeleton(cloneName);
136 },
137 ::py::arg("cloneName"))
138 .def(
139 "isStillChain", +[](const dart::dynamics::Chain* self) -> bool {
140 return self->isStillChain();
141 });
142
143 ::py::class_<dart::dynamics::Chain::Criteria>(m, "ChainCriteria")
144 .def(
145 ::py::init<dart::dynamics::BodyNode*, dart::dynamics::BodyNode*>(),
146 ::py::arg("start"),
147 ::py::arg("target"))
148 .def(
149 ::py::init<
150 dart::dynamics::BodyNode*,
151 dart::dynamics::BodyNode*,
152 bool>(),
153 ::py::arg("start"),
154 ::py::arg("target"),
155 ::py::arg("includeBoth"))
156 .def(
157 "satisfy",
158 +[](const dart::dynamics::Chain::Criteria* self)
159 -> std::vector<dart::dynamics::BodyNode*> {
160 return self->satisfy();
161 })
162 .def(
163 "convert",
164 +[](const dart::dynamics::Chain::Criteria* self)
165 -> dart::dynamics::Linkage::Criteria { return self->convert(); })
166 .def_static(
167 "static_convert",
168 +[](const dart::dynamics::Linkage::Criteria& criteria)
169 -> dart::dynamics::Chain::Criteria {
170 return dart::dynamics::Chain::Criteria::convert(criteria);
171 },
172 ::py::arg("criteria"))
173 .def_readwrite("mStart", &dart::dynamics::Chain::Criteria::mStart)
174 .def_readwrite("mTarget", &dart::dynamics::Chain::Criteria::mTarget)
175 .def_readwrite(
176 "mIncludeUpstreamParentJoint",
177 &dart::dynamics::Chain::Criteria::mIncludeUpstreamParentJoint);
178 }
179
180 } // namespace python
181 } // namespace dart