Car like motion going only forward. More...
#include <hpp/core/dubins-path.hh>
Public Types | |
typedef core::Path | parent_t |
Public Member Functions | |
virtual | ~DubinsPath () 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... | |
![]() | |
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 DubinsPathPtr_t | create (const DevicePtr_t &device, ConfigurationIn_t init, ConfigurationIn_t end, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels) |
Create instance and return shared pointer. More... | |
static DubinsPathPtr_t | create (const DevicePtr_t &device, ConfigurationIn_t init, ConfigurationIn_t end, 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 DubinsPathPtr_t | createCopy (const DubinsPathPtr_t &path) |
Create copy and return shared pointer. More... | |
static DubinsPathPtr_t | createCopy (const DubinsPathPtr_t &path, const ConstraintSetPtr_t &constraints) |
Create copy and return shared pointer. More... | |
Protected Member Functions | |
virtual std::ostream & | print (std::ostream &os) const |
Print path in a stream. More... | |
DubinsPath (const DevicePtr_t &robot, ConfigurationIn_t init, ConfigurationIn_t end, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels) | |
Constructor. More... | |
DubinsPath (const DevicePtr_t &robot, ConfigurationIn_t init, ConfigurationIn_t end, value_type rho, size_type xyId, size_type rzId, const std::vector< JointPtr_t > wheels, ConstraintSetPtr_t constraints) | |
Constructor with constraints. More... | |
DubinsPath (const DubinsPath &path) | |
Copy constructor. More... | |
DubinsPath (const DubinsPath &path, const ConstraintSetPtr_t &constraints) | |
Copy constructor with constraints. More... | |
void | init (DubinsPathPtr_t self) |
virtual bool | impl_compute (ConfigurationOut_t result, value_type param) const |
Function evaluation without applying constraints. More... | |
virtual void | impl_derivative (vectorOut_t result, const value_type &t, size_type order) const |
Virtual implementation of derivative. 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... | |
virtual PathPtr_t | impl_extract (const interval_t ¶mInterval) const throw (projection_error) |
Virtual implementation of extract. More... | |
Additional Inherited Members | |
![]() | |
interval_t | paramRange_ |
Interval of parameters. More... | |
Car like motion going only forward.
Implement a Dubins 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 hpp::core::Path::constraints(), create(), device(), end(), and init().
|
protected |
Constructor.
Referenced by createCopy(), and print().
|
protected |
Constructor with constraints.
|
protected |
Copy constructor.
|
protected |
Copy constructor with constraints.
|
inlinevirtual |
Return a shared pointer to a copy of this object.
Implements hpp::core::Path.
References createCopy().
|
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. |
Implements hpp::core::Path.
References hpp::core::Path::constraints(), and createCopy().
|
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. |
xyId,rzId | indices in configuration vector of translation and rotation of the car, |
wheels | vector of joints that represent turning wheels. |
Referenced by ~DubinsPath().
|
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. |
xyId,rzId | indices in configuration vector of translation and rotation of the car, |
wheels | vector of joints that represent turning wheels, |
constraints | the path is subject to |
|
inlinestatic |
Create copy and return shared pointer.
path | path to copy |
References DubinsPath(), and init().
Referenced by copy().
|
inlinestatic |
Create copy and return shared pointer.
path | path to copy |
constraints | the path is subject to |
References DubinsPath(), and init().
|
inline |
Return the internal robot.
Referenced by ~DubinsPath().
|
inlinevirtual |
|
protectedvirtual |
Function evaluation without applying constraints.
Implements hpp::core::Path.
Referenced by print().
|
protectedvirtual |
|
protected |
Referenced by createCopy(), print(), and ~DubinsPath().
|
inlinevirtual |
Get the initial configuration.
Implements hpp::core::Path.
|
inlineprotectedvirtual |
Print path in a stream.
Reimplemented from hpp::core::Path.
References d, DubinsPath(), impl_compute(), impl_derivative(), init(), and hpp::core::Path::print().