Car like motion. More...
#include <hpp/core/reeds-shepp-path.hh>
Public Types | |
typedef core::PathVector | parent_t |
![]() | |
typedef Path | parent_t |
Public Member Functions | |
virtual | ~ReedsSheppPath () throw () |
Destructor. More... | |
virtual PathPtr_t | copy () const |
Return a shared pointer to a copy of this object. More... | |
virtual PathPtr_t | copy (const ConstraintSetPtr_t &constraints) const |
Return a shared pointer to a copy of this and set constraints. More... | |
DevicePtr_t | device () const |
Return the internal robot. More... | |
Configuration_t | initial () const |
Get the initial configuration. More... | |
Configuration_t | end () const |
Get the final configuration. More... | |
![]() | |
std::size_t | numberPaths () const |
Get the number of sub paths. More... | |
PathPtr_t | pathAtRank (std::size_t rank) const |
Get a path in the vector. More... | |
std::size_t | rankAtParam (const value_type ¶m, value_type &localParam) const |
Get rank of direct path in vector at param. More... | |
void | appendPath (const PathPtr_t &path) |
Append a path at the end of the vector. More... | |
void | concatenate (const PathVector &path) HPP_CORE_DEPRECATED |
Concatenate two vectors of path. More... | |
void | concatenate (const PathVectorPtr_t &path) |
Concatenate two vectors of path. More... | |
void | flatten (PathVectorPtr_t flattenedPath) const |
Return the a path vector representing the same path but ensuring that there is no PathVector in the PathVector. More... | |
virtual | ~PathVector () throw () |
Destructor. More... | |
![]() | |
virtual | ~Path () throw () |
Destructor. More... | |
template<class T > | |
boost::shared_ptr< T > | as (void) |
Static cast into a derived type. More... | |
template<class T > | |
boost::shared_ptr< const T > | as (void) const |
Static cast into a derived type. More... | |
PathPtr_t | extract (const interval_t &subInterval) const throw (projection_error) |
virtual PathPtr_t | reverse () const |
Reversion of a path. More... | |
Configuration_t | operator() (const value_type &time) const HPP_CORE_DEPRECATED |
Configuration_t | operator() (const value_type &time, bool &success) const |
bool | operator() (ConfigurationOut_t result, const value_type &time) const throw () |
bool | at (const value_type &time, ConfigurationOut_t result) const |
Get the configuration at a parameter without applying the constraints. More... | |
void | derivative (vectorOut_t result, const value_type &time, size_type order) const |
Get derivative with respect to parameter at given parameter. More... | |
void | velocityBound (vectorOut_t result, const value_type &t0, const value_type &t1) const |
Get an upper bound of the velocity on a sub-interval. More... | |
size_type | outputSize () const |
Get size of configuration space. More... | |
size_type | outputDerivativeSize () const |
Get size of velocity. More... | |
const interval_t & | timeRange () const |
Get interval of definition. More... | |
value_type | length () const |
Get length of definition interval. More... | |
const ConstraintSetPtr_t & | constraints () const |
Get constraints the path is subject to. More... | |
const interval_t & | paramRange () const |
Get interval of parameters. More... | |
void | timeParameterization (const TimeParameterizationPtr_t &tp, const interval_t &tr) |
Set the time parameterization function. More... | |
Static Public Member Functions | |
static ReedsSheppPathPtr_t | create (const pinocchio::DevicePtr_t &device, ConfigurationIn_t init, ConfigurationIn_t end, value_type extraLength, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels) |
Create instance and return shared pointer. More... | |
static ReedsSheppPathPtr_t | create (const DevicePtr_t &device, ConfigurationIn_t init, ConfigurationIn_t end, value_type extraLength, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels, ConstraintSetPtr_t constraints) |
Create instance and return shared pointer. More... | |
static ReedsSheppPathPtr_t | createCopy (const ReedsSheppPathPtr_t &path) |
Create copy and return shared pointer. More... | |
static ReedsSheppPathPtr_t | createCopy (const ReedsSheppPathPtr_t &path, const ConstraintSetPtr_t &constraints) |
Create copy and return shared pointer. More... | |
![]() | |
static PathVectorPtr_t | create (size_type outputSize, size_type outputDerivativeSize) |
Create instance and return shared pointer. More... | |
static PathVectorPtr_t | createCopy (const PathVectorPtr_t &original) |
Create instance and return shared pointer. More... | |
static PathVectorPtr_t | createCopy (const PathVectorPtr_t &original, const ConstraintSetPtr_t &constraints) |
Create instance and return shared pointer. More... | |
Protected Member Functions | |
virtual std::ostream & | print (std::ostream &os) const |
Print path in a stream. More... | |
ReedsSheppPath (const DevicePtr_t &robot, ConfigurationIn_t init, ConfigurationIn_t end, value_type extraLength, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels) | |
Constructor. More... | |
ReedsSheppPath (const DevicePtr_t &robot, ConfigurationIn_t init, ConfigurationIn_t end, value_type extraLength, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels, ConstraintSetPtr_t constraints) | |
Constructor with constraints. More... | |
ReedsSheppPath (const ReedsSheppPath &path) | |
Copy constructor. More... | |
ReedsSheppPath (const ReedsSheppPath &path, const ConstraintSetPtr_t &constraints) | |
Copy constructor with constraints. More... | |
void | init (ReedsSheppPathPtr_t self) |
virtual void | impl_derivative (vectorOut_t result, const value_type &t, size_type order) const |
Virtual implementation of derivative. More... | |
![]() | |
PathVector (std::size_t outputSize, std::size_t outputDerivativeSize) | |
Constructor. More... | |
PathVector (const PathVector &path) | |
Copy constructor. More... | |
PathVector (const PathVector &path, const ConstraintSetPtr_t &constraints) | |
Copy constructor with constraints. More... | |
void | init (PathVectorPtr_t self) |
virtual bool | impl_compute (ConfigurationOut_t result, value_type t) const |
Function evaluation without applying constraints. More... | |
virtual PathPtr_t | impl_extract (const interval_t &subInterval) const throw (projection_error) |
Extraction of a sub-path. More... | |
![]() | |
Path (const interval_t &interval, size_type outputSize, size_type outputDerivativeSize, const ConstraintSetPtr_t &constraints) | |
Constructor. More... | |
Path (const interval_t &interval, size_type outputSize, size_type outputDerivativeSize) | |
Constructor. More... | |
Path (const Path &path) | |
Copy constructor. More... | |
Path (const Path &path, const ConstraintSetPtr_t &constraints) | |
Copy constructor with constraints. More... | |
void | init (const PathWkPtr_t &self) |
Store weak pointer to itself. More... | |
void | constraints (const ConstraintSetPtr_t &constraint) |
Set the constraints. More... | |
virtual void | checkPath () const |
Should be called by child classes after having init. More... | |
void | timeRange (const interval_t &timeRange) |
const TimeParameterizationPtr_t & | timeParameterization () const |
value_type | paramLength () const |
Configuration_t | configAtParam (const value_type ¶m, bool &success) const |
virtual void | impl_velocityBound (vectorOut_t bound, const value_type ¶m0, const value_type ¶m1) const |
Virtual implementation of velocityBound. More... | |
Additional Inherited Members | |
![]() | |
interval_t | paramRange_ |
Interval of parameters. More... | |
Car like motion.
Implement a Reeds and Shepp motion generation on the base joint. Degrees of freedom are interpolated depending on the type of joint they parameterize: The following interpolation is made:
|
inlinevirtual |
Destructor.
References create().
|
protected |
Constructor.
|
protected |
Constructor with constraints.
|
protected |
Copy constructor.
|
protected |
Copy constructor with constraints.
|
inlinevirtual |
Return a shared pointer to a copy of this object.
Reimplemented from hpp::core::PathVector.
|
inlinevirtual |
Return a shared pointer to a copy of this and set constraints.
constraints | constraints to apply to the copy *this should not have constraints. |
Reimplemented from hpp::core::PathVector.
|
static |
Create instance and return shared pointer.
device | Robot corresponding to configurations |
init,end | Start and end configurations of the path |
rho | The radius of a turn. |
extraLength | the length of the path due to the non RS DoF |
|
static |
Create instance and return shared pointer.
device | Robot corresponding to configurations |
init,end | Start and end configurations of the path |
rho | The radius of a turn. |
extraLength | the length of the path due to the non RS DoF |
constraints | the path is subject to |
|
inlinestatic |
|
inlinestatic |
Create copy and return shared pointer.
path | path to copy |
constraints | the path is subject to |
References init().
|
inline |
Return the internal robot.
|
inlinevirtual |
Get the final configuration.
Reimplemented from hpp::core::PathVector.
|
protectedvirtual |
Virtual implementation of derivative.
Reimplemented from hpp::core::PathVector.
|
protected |
Referenced by createCopy().
|
inlinevirtual |
Get the initial configuration.
Reimplemented from hpp::core::PathVector.
|
protectedvirtual |
Print path in a stream.
Reimplemented from hpp::core::PathVector.