hpp-rbprm
4.10.1
Implementation of RB-PRM planner using hpp.
|
Go to the documentation of this file.
19 #ifndef HPP_RBPRM_TIMED_PARABOLA_PATH_HH
20 #define HPP_RBPRM_TIMED_PARABOLA_PATH_HH
58 core::ConfigurationIn_t
end, core::value_type
length,
73 core::ConfigurationIn_t
end, core::value_type
length,
74 core::vector_t
coefficients, core::vector_t V0, core::vector_t Vimp,
75 std::vector<std::string> initialROMnames,
76 std::vector<std::string> endROMnames) {
98 const core::ConstraintSetPtr_t& ) {
116 virtual core::PathPtr_t
copy(
const core::ConstraintSetPtr_t& constraints)
const {
124 virtual core::PathPtr_t
extract(
const core::interval_t& subInterval)
const throw(core::projection_error);
128 virtual core::PathPtr_t
reverse()
const;
135 assert(
initial.size() == initial_.size());
144 assert(
end.size() == end_.size());
149 core::DevicePtr_t
device()
const;
152 core::Configuration_t
initial()
const {
return initial_; }
155 core::Configuration_t
end()
const {
return end_; }
158 virtual core::value_type
length()
const {
return length_; }
171 core::value_type
length, core::vector_t coefs, core::vector_t V0, core::vector_t Vimp,
172 std::vector<std::string> initialROMnames, std::vector<std::string> endROMnames);
183 virtual bool impl_compute(core::ConfigurationOut_t result, core::value_type t)
const;
189 virtual std::ostream&
print(std::ostream& os)
const {
190 os <<
"TimedParabolaPath:" << std::endl;
191 os <<
"interval: [ " << timeRange().first <<
", " << timeRange().second <<
" ]" << std::endl;
192 os <<
"initial configuration: " << initial_.transpose() << std::endl;
193 os <<
"final configuration: " << end_.transpose() << std::endl;
198 core::DevicePtr_t device_;
199 core::Configuration_t initial_;
200 core::Configuration_t end_;
201 TimedParabolaPathWkPtr_t weak_;
203 mutable core::value_type length_;
209 #endif // HPP_RBPRM_TIMED_PARABOLA_PATH_HH
virtual core::value_type length() const
Get previously computed length.
Definition: timed-parabola-path.hh:158
void initialConfig(core::ConfigurationIn_t initial)
Definition: timed-parabola-path.hh:134
static TimedParabolaPathPtr_t createCopy(const TimedParabolaPathPtr_t &path, const core::ConstraintSetPtr_t &)
Definition: timed-parabola-path.hh:97
HPP_PREDEF_CLASS(RbPrmFullBody)
ParabolaPath parent_t
Definition: timed-parabola-path.hh:37
virtual core::PathPtr_t copy(const core::ConstraintSetPtr_t &constraints) const
Definition: timed-parabola-path.hh:116
virtual std::ostream & print(std::ostream &os) const
Print path in a stream.
Definition: timed-parabola-path.hh:189
static TimedParabolaPathPtr_t create(const core::DevicePtr_t &device, core::ConfigurationIn_t init, core::ConfigurationIn_t end, core::value_type length, core::vector_t coefficients)
Definition: timed-parabola-path.hh:57
virtual core::PathPtr_t extract(const core::interval_t &subInterval) const
virtual core::PathPtr_t copy() const
Definition: timed-parabola-path.hh:110
virtual double computeTimedLength(double x_theta, double v0, double alpha0)
TimedParabolaPath(const core::DevicePtr_t &robot, core::ConfigurationIn_t init, core::ConfigurationIn_t end, ParabolaPathPtr_t parabolaPath)
Constructor.
core::Configuration_t end() const
Get the final configuration.
Definition: timed-parabola-path.hh:155
Definition: timed-parabola-path.hh:35
static TimedParabolaPathPtr_t create(const core::DevicePtr_t &device, core::ConfigurationIn_t init, core::ConfigurationIn_t end, ParabolaPathPtr_t parabolaPath)
Definition: timed-parabola-path.hh:45
void init(TimedParabolaPathPtr_t self)
Definition: timed-parabola-path.hh:177
core::vector_t coefficients() const
Get path coefficients.
Definition: parabola-path.hh:160
static TimedParabolaPathPtr_t create(const core::DevicePtr_t &device, core::ConfigurationIn_t init, core::ConfigurationIn_t end, core::value_type length, core::vector_t coefficients, core::vector_t V0, core::vector_t Vimp, std::vector< std::string > initialROMnames, std::vector< std::string > endROMnames)
Definition: timed-parabola-path.hh:72
Definition: parabola-path.hh:44
Definition: algorithm.hh:27
core::Configuration_t initial() const
Get the initial configuration.
Definition: timed-parabola-path.hh:152
void endConfig(core::ConfigurationIn_t end)
Definition: timed-parabola-path.hh:143
core::DevicePtr_t device() const
Return the internal robot.
void init(ParabolaPathPtr_t self)
Definition: parabola-path.hh:200
virtual ~TimedParabolaPath()
Destructor.
Definition: timed-parabola-path.hh:39
virtual core::PathPtr_t reverse() const
boost::shared_ptr< ParabolaPath > ParabolaPathPtr_t
Definition: parabola-path.hh:33
static TimedParabolaPathPtr_t createCopy(const TimedParabolaPathPtr_t &path)
Definition: timed-parabola-path.hh:86
boost::shared_ptr< TimedParabolaPath > TimedParabolaPathPtr_t
Definition: timed-parabola-path.hh:30
virtual bool impl_compute(core::ConfigurationOut_t result, core::value_type t) const
Param is the time.