hpp-core  6.0.0
Implement basic classes for canonical path planning for kinematic chains.
recursive-hermite.hh
Go to the documentation of this file.
1 // Copyright (c) 2016, LAAS-CNRS
2 // Authors: Joseph Mirabel (joseph.mirabel@laas.fr)
3 //
4 
5 // Redistribution and use in source and binary forms, with or without
6 // modification, are permitted provided that the following conditions are
7 // met:
8 //
9 // 1. Redistributions of source code must retain the above copyright
10 // notice, this list of conditions and the following disclaimer.
11 //
12 // 2. Redistributions in binary form must reproduce the above copyright
13 // notice, this list of conditions and the following disclaimer in the
14 // documentation and/or other materials provided with the distribution.
15 //
16 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
17 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
18 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
19 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
20 // HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
21 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
22 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
27 // DAMAGE.
28 
29 #ifndef HPP_CORE_PATHPROJECTOR_RECURSIVE_HERMITE_HH
30 #define HPP_CORE_PATHPROJECTOR_RECURSIVE_HERMITE_HH
31 
32 #include "hpp/core/config.hh"
33 #include "hpp/core/fwd.hh"
35 
36 namespace hpp {
37 namespace core {
38 namespace pathProjector {
43  public:
46 
47  static RecursiveHermitePtr_t create(const DistancePtr_t& distance,
48  const SteeringMethodPtr_t& steeringMethod,
49  value_type step);
50 
52  const value_type& step);
53 
54  protected:
55  bool impl_apply(const PathPtr_t& path, PathPtr_t& projection) const;
56 
58  const SteeringMethodPtr_t& steeringMethod,
59  const value_type& M, const value_type& beta);
60 
61  bool project(const PathPtr_t& path, PathPtr_t& proj) const;
62 
63  private:
64  bool recurse(const HermitePtr_t& path, PathVectorPtr_t& proj,
65  const value_type& thr) const;
66  value_type M_, beta_;
67 };
68 } // namespace pathProjector
69 } // namespace core
70 } // namespace hpp
71 
72 #endif // HPP_CORE_PATHPROJECTOR_RECURSIVE_HERMITE_HH
This class projects a path using constraints.
Definition: path-projector.hh:38
hpp::core::PathPtr_t PathPtr_t
Definition: path-projector.hh:41
hpp::core::PathVectorPtr_t PathVectorPtr_t
Definition: path-projector.hh:43
Definition: recursive-hermite.hh:42
bool impl_apply(const PathPtr_t &path, PathPtr_t &projection) const
Method to be reimplemented by inherited class.
RecursiveHermite(const DistancePtr_t &distance, const SteeringMethodPtr_t &steeringMethod, const value_type &M, const value_type &beta)
hpp::core::path::Hermite Hermite
Definition: recursive-hermite.hh:44
static RecursiveHermitePtr_t create(const DistancePtr_t &distance, const SteeringMethodPtr_t &steeringMethod, value_type step)
hpp::core::path::HermitePtr_t HermitePtr_t
Definition: recursive-hermite.hh:45
bool project(const PathPtr_t &path, PathPtr_t &proj) const
static RecursiveHermitePtr_t create(const ProblemConstPtr_t &problem, const value_type &step)
Definition: hermite.hh:42
#define HPP_CORE_DLLAPI
Definition: config.hh:88
shared_ptr< RecursiveHermite > RecursiveHermitePtr_t
Definition: fwd.hh:334
shared_ptr< Hermite > HermitePtr_t
Definition: fwd.hh:246
pinocchio::value_type value_type
Definition: fwd.hh:174
shared_ptr< Distance > DistancePtr_t
Definition: fwd.hh:141
shared_ptr< SteeringMethod > SteeringMethodPtr_t
Definition: fwd.hh:213
shared_ptr< const Problem > ProblemConstPtr_t
Definition: fwd.hh:197
Definition: bi-rrt-planner.hh:35