30 #ifndef HPP_CORE_STEERING_METHOD_CONSTANT_CURVATURE_HH 31 #define HPP_CORE_STEERING_METHOD_CONSTANT_CURVATURE_HH 39 namespace steeringMethod {
64 const std::vector<JointPtr_t> wheels,
101 virtual std::ostream&
print(std::ostream& os)
const;
121 const std::vector<JointPtr_t> wheels);
142 const std::vector<JointPtr_t> wheels,
164 void init(
const ConstantCurvatureWkPtr_t& weak) {
178 const std::vector<JointPtr_t> wheels);
188 std::vector<Wheels_t> wheels_;
189 ConstantCurvatureWkPtr_t weak_;
197 #endif // HPP_CORE_STEERING_METHOD_CONSTANT_CURVATURE_HH virtual void impl_velocityBound(vectorOut_t bound, const value_type ¶m0, const value_type ¶m1) const
Virtual implementation of velocity bound.
Wheels_t()
Definition: constant-curvature.hh:96
virtual std::ostream & print(std::ostream &os) const
Print path in a stream.
virtual bool impl_compute(ConfigurationOut_t result, value_type param) const
Function evaluation without applying constraints.
pinocchio::DevicePtr_t DevicePtr_t
Definition: fwd.hh:133
pinocchio::ConfigurationIn_t ConfigurationIn_t
Definition: fwd.hh:106
Definition: bi-rrt-planner.hh:35
ConstantCurvature()
For serialization only.
Definition: constant-curvature.hh:170
std::pair< value_type, value_type > interval_t
Definition: fwd.hh:174
pinocchio::ConfigurationOut_t ConfigurationOut_t
Definition: fwd.hh:107
Path parent_t
Definition: constant-curvature.hh:43
pinocchio::size_type size_type
Definition: fwd.hh:172
static ConstantCurvaturePtr_t createCopy(const ConstantCurvaturePtr_t &other)
Create instance and return shared pointer.
pinocchio::JointPtr_t JointPtr_t
Definition: fwd.hh:150
const ConstraintSetPtr_t & constraints() const
Get constraints the path is subject to.
Definition: path.hh:217
virtual PathPtr_t copy(const ConstraintSetPtr_t &constraints) const
Definition: constant-curvature.hh:81
value_type value
Definition: constant-curvature.hh:94
shared_ptr< ConstantCurvature > ConstantCurvaturePtr_t
Definition: fwd.hh:43
Configuration_t end() const
Get the final configuration.
Definition: constant-curvature.hh:89
void init(const PathWkPtr_t &self)
Definition: constant-curvature.hh:93
JointPtr_t j
Definition: constant-curvature.hh:95
Path of constant curvature for a carlike robot.
Definition: constant-curvature.hh:41
void init(const ConstantCurvatureWkPtr_t &weak)
store weak pointer to itself
Definition: constant-curvature.hh:164
virtual PathPtr_t copy() const
Return a shared pointer to a copy of this.
shared_ptr< ConstraintSet > ConstraintSetPtr_t
Definition: fwd.hh:129
pinocchio::value_type value_type
Definition: fwd.hh:173
Configuration_t initial() const
Get the initial configuration.
Definition: constant-curvature.hh:86
static ConstantCurvaturePtr_t create(const DevicePtr_t &robot, ConfigurationIn_t init, ConfigurationIn_t end, value_type curveLength, value_type pathLength, value_type curvature, size_type xyId, size_type rzId, const JointPtr_t rz, const std::vector< JointPtr_t > wheels, const ConstraintSetPtr_t &constraints)
pinocchio::vectorOut_t vectorOut_t
Definition: fwd.hh:221
virtual ~ConstantCurvature()
Definition: constant-curvature.hh:44
pinocchio::Configuration_t Configuration_t
Definition: fwd.hh:105
virtual void impl_derivative(vectorOut_t result, const value_type ¶m, size_type order) const
Virtual implementation of derivative.
virtual PathPtr_t reverse() const
virtual PathPtr_t impl_extract(const interval_t ¶mInterval) const
Virtual implementation of path extraction.
shared_ptr< Path > PathPtr_t
Definition: fwd.hh:186