Debian Codegraph @

python/dartpy/dynamics/Linkage.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 Linkage(py::module& m)
45 {
46 ::py::class_<
47 dart::dynamics::Linkage,
48 dart::dynamics::ReferentialSkeleton,
49 std::shared_ptr<dart::dynamics::Linkage>>(m, "Linkage")
50 .def(
51 ::py::init(
52 +[](const dart::dynamics::Linkage::Criteria& criteria)
53 -> dart::dynamics::LinkagePtr {
54 return dart::dynamics::Linkage::create(criteria);
55 }),
56 ::py::arg("criteria"))
57 .def(
58 ::py::init(
59 +[](const dart::dynamics::Linkage::Criteria& criteria,
60 const std::string& name) -> dart::dynamics::LinkagePtr {
61 return dart::dynamics::Linkage::create(criteria, name);
62 }),
63 ::py::arg("criteria"),
64 ::py::arg("name"))
65 .def(
66 "cloneLinkage",
67 +[](const dart::dynamics::Linkage* self)
68 -> dart::dynamics::LinkagePtr { return self->cloneLinkage(); })
69 .def(
70 "cloneLinkage",
71 +[](const dart::dynamics::Linkage* self,
72 const std::string& cloneName) -> dart::dynamics::LinkagePtr {
73 return self->cloneLinkage(cloneName);
74 },
75 ::py::arg("cloneName"))
76 .def(
77 "cloneMetaSkeleton",
78 +[](const dart::dynamics::Linkage* self,
79 const std::string& cloneName) -> dart::dynamics::MetaSkeletonPtr {
80 return self->cloneMetaSkeleton(cloneName);
81 },
82 ::py::arg("cloneName"))
83 .def(
84 "isAssembled",
85 +[](const dart::dynamics::Linkage* self) -> bool {
86 return self->isAssembled();
87 })
88 .def(
89 "reassemble",
90 +[](dart::dynamics::Linkage* self) { self->reassemble(); })
91 .def(
92 "satisfyCriteria",
93 +[](dart::dynamics::Linkage* self) { self->satisfyCriteria(); });
94
95 ::py::class_<dart::dynamics::Linkage::Criteria>(m, "LinkageCriteria")
96 .def(
97 "satisfy",
98 +[](const dart::dynamics::Linkage::Criteria* self)
99 -> std::vector<dart::dynamics::BodyNode*> {
100 return self->satisfy();
101 })
102 .def_readwrite("mStart", &dart::dynamics::Linkage::Criteria::mStart)
103 .def_readwrite("mTargets", &dart::dynamics::Linkage::Criteria::mTargets)
104 .def_readwrite(
105 "mTerminals", &dart::dynamics::Linkage::Criteria::mTerminals);
106
107 ::py::enum_<dart::dynamics::Linkage::Criteria::ExpansionPolicy>(
108 m.attr("LinkageCriteria"), "ExpansionPolicy")
109 .value(
110 "INCLUDE",
111 dart::dynamics::Linkage::Criteria::ExpansionPolicy::INCLUDE)
112 .value(
113 "EXCLUDE",
114 dart::dynamics::Linkage::Criteria::ExpansionPolicy::EXCLUDE)
115 .value(
116 "DOWNSTREAM",
117 dart::dynamics::Linkage::Criteria::ExpansionPolicy::DOWNSTREAM)
118 .value(
119 "UPSTREAM",
120 dart::dynamics::Linkage::Criteria::ExpansionPolicy::UPSTREAM)
121 .export_values();
122
123 ::py::class_<dart::dynamics::Linkage::Criteria::Terminal>(
124 m.attr("LinkageCriteria"), "Terminal")
125 .def(::py::init<>())
126 .def(::py::init<dart::dynamics::BodyNode*>(), ::py::arg("terminal"))
127 .def(
128 ::py::init<dart::dynamics::BodyNode*, bool>(),
129 ::py::arg("terminal"),
130 ::py::arg("inclusive"))
131 .def_readwrite(
132 "mTerminal", &dart::dynamics::Linkage::Criteria::Terminal::mTerminal)
133 .def_readwrite(
134 "mInclusive",
135 &dart::dynamics::Linkage::Criteria::Terminal::mInclusive);
136
137 ::py::class_<dart::dynamics::Linkage::Criteria::Target>(
138 m.attr("LinkageCriteria"), "Target")
139 .def(::py::init<>())
140 .def(::py::init<dart::dynamics::BodyNode*>(), ::py::arg("target"))
141 .def(
142 ::py::init<
143 dart::dynamics::BodyNode*,
144 dart::dynamics::Linkage::Criteria::ExpansionPolicy>(),
145 ::py::arg("target"),
146 ::py::arg("policy"))
147 .def(
148 ::py::init<
149 dart::dynamics::BodyNode*,
150 dart::dynamics::Linkage::Criteria::ExpansionPolicy,
151 bool>(),
152 ::py::arg("target"),
153 ::py::arg("policy"),
154 ::py::arg("chain"))
155 .def_readwrite("mNode", &dart::dynamics::Linkage::Criteria::Target::mNode)
156 .def_readwrite(
157 "mPolicy", &dart::dynamics::Linkage::Criteria::Target::mPolicy)
158 .def_readwrite(
159 "mChain", &dart::dynamics::Linkage::Criteria::Target::mChain);
160 }
161
162 } // namespace python
163 } // namespace dart