Loading...
Searching...
No Matches
SE2RN_R2.cpp
48Projection_SE2RN_R2::Projection_SE2RN_R2(ompl::base::StateSpacePtr BundleSpace, ompl::base::StateSpacePtr BaseSpace)
54void Projection_SE2RN_R2::projectFiber(const ompl::base::State *xBundle, ompl::base::State *xFiber) const
56 const auto *xBundle_SE2 = xBundle->as<base::CompoundState>()->as<base::SE2StateSpace::StateType>(0);
57 const auto *xBundle_RN = xBundle->as<base::CompoundState>()->as<base::RealVectorStateSpace::StateType>(1);
60 auto *xFiber_RN = xFiber->as<base::CompoundState>()->as<base::RealVectorStateSpace::StateType>(1);
69void Projection_SE2RN_R2::project(const ompl::base::State *xBundle, ompl::base::State *xBase) const
71 const auto *xBundle_SE2 = xBundle->as<base::CompoundState>()->as<base::SE2StateSpace::StateType>(0);
81 auto *xBundle_RN = xBundle->as<base::CompoundState>()->as<base::RealVectorStateSpace::StateType>(1);
85 const auto *xFiber_SO2 = xFiber->as<base::CompoundState>()->as<base::SO2StateSpace::StateType>(0);
86 const auto *xFiber_RN = xFiber->as<base::CompoundState>()->as<base::RealVectorStateSpace::StateType>(1);
A space to allow the composition of state spaces.
Definition StateSpace.h:574
const std::vector< StateSpacePtr > & getSubspaces() const
Get the list of components.
Definition StateSpace.cpp:978
The definition of a state in Rn
Definition RealVectorStateSpace.h:78
A state space representing Rn. The distance function is the L2 norm.
Definition RealVectorStateSpace.h:74
unsigned int getDimension() const override
Get the dimension of the space (not the dimension of the surrounding ambient space)
Definition RealVectorStateSpace.cpp:138
A state space representing SO(2). The distance function and interpolation take into account angle wra...
Definition SO2StateSpace.h:64
A shared pointer wrapper for ompl::base::StateSpace.
This namespace contains datastructures and planners to exploit multilevel abstractions,...
Definition MultiLevelPlanarManipulatorDemo.cpp:68