footprint_helper.h
Go to the documentation of this file.
1 /*********************************************************************
2  *
3  * Software License Agreement (BSD License)
4  *
5  * Copyright (c) 2008, Willow Garage, Inc.
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  *
12  * * Redistributions of source code must retain the above copyright
13  * notice, this list of conditions and the following disclaimer.
14  * * Redistributions in binary form must reproduce the above
15  * copyright notice, this list of conditions and the following
16  * disclaimer in the documentation and/or other materials provided
17  * with the distribution.
18  * * Neither the name of Willow Garage, Inc. nor the names of its
19  * contributors may be used to endorse or promote products derived
20  * from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
30  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33  * POSSIBILITY OF SUCH DAMAGE.
34  *
35  * Author: TKruse
36  *********************************************************************/
37 
38 #ifndef FOOTPRINT_HELPER_H_
39 #define FOOTPRINT_HELPER_H_
40 
41 #include <vector>
42 
43 #include <costmap_2d/costmap_2d.h>
44 #include <geometry_msgs/Point.h>
45 #include <Eigen/Core>
46 #include <base_local_planner/Position2DInt.h>
47 
48 namespace base_local_planner {
49 
50 class FootprintHelper {
51 public:
53  virtual ~FootprintHelper();
54 
63  std::vector<base_local_planner::Position2DInt> getFootprintCells(
64  Eigen::Vector3f pos,
65  std::vector<geometry_msgs::Point> footprint_spec,
66  const costmap_2d::Costmap2D&,
67  bool fill);
68 
77  void getLineCells(int x0, int x1, int y0, int y1, std::vector<base_local_planner::Position2DInt>& pts);
78 
83  void getFillCells(std::vector<base_local_planner::Position2DInt>& footprint);
84 };
85 
86 } /* namespace base_local_planner */
87 #endif /* FOOTPRINT_HELPER_H_ */
base_local_planner::FootprintHelper::getFillCells
void getFillCells(std::vector< base_local_planner::Position2DInt > &footprint)
Fill the outline of a polygon, in this case the robot footprint, in a grid.
Definition: footprint_helper.cpp:158
costmap_2d.h
base_local_planner::FootprintHelper::~FootprintHelper
virtual ~FootprintHelper()
Definition: footprint_helper.cpp:82
costmap_2d::Costmap2D
base_local_planner::FootprintHelper::FootprintHelper
FootprintHelper()
Definition: footprint_helper.cpp:77
base_local_planner::FootprintHelper::getLineCells
void getLineCells(int x0, int x1, int y0, int y1, std::vector< base_local_planner::Position2DInt > &pts)
Use Bresenham's algorithm to trace a line between two points in a grid.
Definition: footprint_helper.cpp:86
base_local_planner::FootprintHelper::getFootprintCells
std::vector< base_local_planner::Position2DInt > getFootprintCells(Eigen::Vector3f pos, std::vector< geometry_msgs::Point > footprint_spec, const costmap_2d::Costmap2D &, bool fill)
Used to get the cells that make up the footprint of the robot.
Definition: footprint_helper.cpp:215
base_local_planner
Definition: costmap_model.h:44


base_local_planner
Author(s): Eitan Marder-Eppstein, Eric Perko, contradict@gmail.com
autogenerated on Mon Mar 6 2023 03:50:23