30 #ifndef HPP_CORE_PATH_HH 31 #define HPP_CORE_PATH_HH 39 #include <hpp/util/exception.hh> 40 #include <hpp/util/serialization-fwd.hh> 90 shared_ptr<T>
as(
void) {
91 assert(HPP_DYNAMIC_PTR_CAST(T, weak_.lock()));
92 return HPP_STATIC_PTR_CAST(T, weak_.lock());
97 shared_ptr<const T>
as(
void)
const {
98 assert(HPP_DYNAMIC_PTR_CAST(
const T, weak_.lock()));
99 return HPP_STATIC_PTR_CAST(
const T, weak_.lock());
117 return extract(std::make_pair(tmin, tmax));
133 return eval(time, success);
139 return eval(result, time);
144 return configAtParam(paramAtTime(time), success);
150 bool success = impl_compute(result, s);
151 if (!success)
return false;
152 return applyConstraints(result, s);
157 return impl_compute(result, paramAtTime(time));
186 assert(result.size() == outputDerivativeSize());
188 impl_velocityBound(result, paramAtTime(std::max(t0, timeRange().first)),
189 paramAtTime(std::min(t1, timeRange().second)));
190 if (timeParam_) result *= timeParam_->derivativeBound(t0, t1);
207 return timeRange_.second - timeRange_.first;
244 virtual std::ostream& print(std::ostream& os)
const;
275 void init(
const PathWkPtr_t&
self);
285 constraints_ = constraint;
289 virtual void checkPath()
const;
292 timeRange_ = timeRange;
294 paramRange_.first = timeParam_->value(timeRange_.first);
295 paramRange_.second = timeParam_->value(timeRange_.second);
297 paramRange_ = timeRange_;
305 return paramRange_.second - paramRange_.first;
310 success = impl_compute(result, param);
311 if (!success)
return result;
312 success = applyConstraints(result, param);
331 HPP_THROW_EXCEPTION(hpp::Exception,
"not implemented");
342 HPP_THROW_EXCEPTION(hpp::Exception,
"not implemented");
354 return timeParam_->value(time);
372 friend std::ostream&
operator<<(std::ostream& os,
const Path& path);
373 friend class ExtractedPath;
382 return path.
print(os);
388 #endif // HPP_CORE_PATH_HH shared_ptr< TimeParameterization > TimeParameterizationPtr_t
Definition: fwd.hh:178
virtual ~Path()
Destructor.
Definition: path.hh:77
size_type outputSize() const
Get size of configuration space.
Definition: path.hh:197
value_type paramLength() const
Definition: path.hh:304
Definition: bi-rrt-planner.hh:35
size_type outputDerivativeSize() const
Get size of velocity.
Definition: path.hh:200
const interval_t & paramRange() const
Definition: path.hh:230
std::pair< value_type, value_type > interval_t
Definition: fwd.hh:164
void velocityBound(vectorOut_t result, const value_type &t0, const value_type &t1) const
Definition: path.hh:184
PathPtr_t extract(const value_type &tmin, const value_type &tmax) const
Definition: path.hh:116
pinocchio::ConfigurationOut_t ConfigurationOut_t
Definition: fwd.hh:107
pinocchio::size_type size_type
Definition: fwd.hh:162
Configuration_t operator()(const value_type &time, bool &success) const HPP_CORE_DEPRECATED
Definition: path.hh:131
void timeRange(const interval_t &timeRange)
Definition: path.hh:291
void timeParameterization(const TimeParameterizationPtr_t &tp, const interval_t &tr)
Set the time parameterization function.
Definition: path.hh:233
shared_ptr< T > as(void)
Static cast into a derived type.
Definition: path.hh:90
virtual value_type length() const
Get length of definition interval.
Definition: path.hh:206
const ConstraintSetPtr_t & constraints() const
Get constraints the path is subject to.
Definition: path.hh:217
Configuration_t configAtParam(const value_type ¶m, bool &success) const
Definition: path.hh:308
interval_t paramRange_
Interval of parameters.
Definition: path.hh:278
Path()
Definition: path.hh:376
const interval_t & timeRange() const
Get interval of definition.
Definition: path.hh:203
Configuration_t eval(const value_type &time, bool &success) const
Configuration at time.
Definition: path.hh:143
#define HPP_CORE_DEPRECATED
Definition: deprecated.hh:32
bool at(const value_type &time, ConfigurationOut_t result) const
Get the configuration at a parameter without applying the constraints.
Definition: path.hh:156
shared_ptr< ConstraintSet > ConstraintSetPtr_t
Definition: fwd.hh:119
shared_ptr< const T > as(void) const
Static cast into a derived type.
Definition: path.hh:97
pinocchio::value_type value_type
Definition: fwd.hh:163
virtual void impl_derivative(vectorOut_t derivative, const value_type ¶m, size_type order) const
Definition: path.hh:326
bool operator()(ConfigurationOut_t result, const value_type &time) const
Definition: path.hh:138
virtual std::ostream & print(std::ostream &os) const
void constraints(const ConstraintSetPtr_t &constraint)
Definition: path.hh:284
const TimeParameterizationPtr_t & timeParameterization() const
Definition: path.hh:300
bool eval(ConfigurationOut_t result, const value_type &time) const
Configuration at time.
Definition: path.hh:148
pinocchio::vectorOut_t vectorOut_t
Definition: fwd.hh:211
virtual void impl_velocityBound(vectorOut_t bound, const value_type ¶m0, const value_type ¶m1) const
Definition: path.hh:337
std::ostream & operator<<(std::ostream &os, const Constraint &constraint)
Definition: constraint.hh:99
#define HPP_CORE_DLLAPI
Definition: config.hh:64
pinocchio::Configuration_t Configuration_t
Definition: fwd.hh:105
shared_ptr< Path > PathPtr_t
Definition: fwd.hh:176