1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
|
#include <pybind11/pybind11.h>
#include <pybind11/operators.h>
#include <pybind11/eigen.h>
#include <pybind11/stl.h>
#include <pybind11/complex.h>
#include "manif/SE2.h"
#include "bindings_optional.h"
#include "bindings_lie_group_base.h"
#include "bindings_tangent_base.h"
namespace py = pybind11;
void wrap_SE2(py::module &m)
{
using Scalar = manif::SE2d::Scalar;
using Translation = manif::SE2d::Translation;
// group declaration and constructors
py::class_<manif::LieGroupBase<manif::SE2d>, std::unique_ptr<manif::LieGroupBase<manif::SE2d>, py::nodelete>> SE2_base(m, "_SE2Base");
py::class_<manif::TangentBase<manif::SE2Tangentd>, std::unique_ptr<manif::TangentBase<manif::SE2Tangentd>, py::nodelete>> SE2_tan_base(m, "_SE2TangentBase");
py::class_<manif::SE2d, manif::LieGroupBase<manif::SE2d>> SE2(m, "SE2");
py::class_<manif::SE2Tangentd, manif::TangentBase<manif::SE2Tangentd>> SE2_tan(m, "SE2Tangent");
// group
SE2.def(py::init<const Scalar, const Scalar, const Scalar>());
SE2.def(py::init<const Scalar, const Scalar, const Scalar, const Scalar>());
SE2.def(py::init<const Scalar, const Scalar, const std::complex<Scalar>&>());
SE2.def(py::init<const Translation&, const std::complex<Scalar>&>());
// SE2.def(py::init<const Eigen::Transform<Scalar, 2, Eigen::Isometry>&>());
wrap_lie_group_base<manif::SE2d, manif::LieGroupBase<manif::SE2d>>(SE2);
SE2.def("transform", &manif::SE2d::transform);
// SE2.def("isometry", &manif::SE2d::isometry);
SE2.def("rotation", &manif::SE2d::rotation);
SE2.def("translation", &manif::SE2d::translation);
SE2.def("real", &manif::SE2d::real);
SE2.def("imag", &manif::SE2d::imag);
SE2.def("angle", &manif::SE2d::angle);
SE2.def("x", &manif::SE2d::x);
SE2.def("y", &manif::SE2d::y);
SE2.def("normalize", &manif::SE2d::normalize);
// tangent
wrap_tangent_base<manif::SE2Tangentd, manif::TangentBase<manif::SE2Tangentd>>(SE2_tan);
SE2_tan.def(py::init<const Scalar, const Scalar, const Scalar>());
SE2_tan.def("x", &manif::SE2Tangentd::x);
SE2_tan.def("y", &manif::SE2Tangentd::y);
SE2_tan.def("angle", &manif::SE2Tangentd::angle);
}
|
