moveit2
The MoveIt Motion Planning Framework for ROS 2.
goal_union.h
Go to the documentation of this file.
1 /*********************************************************************
2  * Software License Agreement (BSD License)
3  *
4  * Copyright (c) 2011, Willow Garage, Inc.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright
12  * notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above
14  * copyright notice, this list of conditions and the following
15  * disclaimer in the documentation and/or other materials provided
16  * with the distribution.
17  * * Neither the name of Willow Garage nor the names of its
18  * contributors may be used to endorse or promote products derived
19  * from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32  * POSSIBILITY OF SUCH DAMAGE.
33  *********************************************************************/
34 
35 /* Author: Ioan Sucan */
36 
37 #include <ompl/base/goals/GoalSampleableRegion.h>
38 
39 namespace ompl_interface
40 {
42 class GoalSampleableRegionMux : public ompl::base::GoalSampleableRegion
43 {
44 public:
47  GoalSampleableRegionMux(const std::vector<ompl::base::GoalPtr>& goals);
48 
50  {
51  }
52 
54  void sampleGoal(ompl::base::State* st) const override;
55 
57  unsigned int maxSampleCount() const override;
58 
60  virtual bool canSample() const;
61 
63  bool couldSample() const override;
64 
66  bool isSatisfied(const ompl::base::State* st, double* distance) const override;
67 
69  double distanceGoal(const ompl::base::State* st) const override;
70 
72  void startSampling();
73 
75  void stopSampling();
76 
78  void print(std::ostream& out = std::cout) const override;
79 
80 protected:
81  std::vector<ompl::base::GoalPtr> goals_;
82  mutable unsigned int gindex_;
83 };
84 } // namespace ompl_interface
void startSampling()
If there are any member lazy samplers, start them.
Definition: goal_union.cpp:61
bool couldSample() const override
Query if sampler could find a sample in the future.
Definition: goal_union.cpp:105
double distanceGoal(const ompl::base::State *st) const override
Find the distance of this state from the goal.
Definition: goal_union.cpp:121
virtual bool canSample() const
Query if sampler can find any sample.
Definition: goal_union.cpp:97
unsigned int maxSampleCount() const override
Get the max sample count.
Definition: goal_union.cpp:89
GoalSampleableRegionMux(const std::vector< ompl::base::GoalPtr > &goals)
Constructor.
Definition: goal_union.cpp:56
void print(std::ostream &out=std::cout) const override
Pretty print goal information.
Definition: goal_union.cpp:133
void sampleGoal(ompl::base::State *st) const override
Sample a goal.
Definition: goal_union.cpp:75
bool isSatisfied(const ompl::base::State *st, double *distance) const override
Is the goal satisfied for this state (given a distance)
Definition: goal_union.cpp:113
std::vector< ompl::base::GoalPtr > goals_
Definition: goal_union.h:81
void stopSampling()
If there are any member lazy samplers, stop them.
Definition: goal_union.cpp:68
The MoveIt interface to OMPL.
double distance(const urdf::Pose &transform)
Definition: pr2_arm_ik.h:55