#include <footstep_state.h>
Public Types | |
typedef boost::shared_ptr< FootstepState > | Ptr |
Public Member Functions | |
pcl::PointIndices::Ptr | cropPointCloud (pcl::PointCloud< pcl::PointNormal >::Ptr cloud, ANNGrid::Ptr grid_search, double padding_x=0.0, double padding_y=0.0) |
pcl::PointIndices::Ptr | cropPointCloudExact (pcl::PointCloud< pcl::PointNormal >::Ptr cloud, pcl::PointIndices::Ptr near_indices, double padding_x=0.0, double padding_y=0.0) |
float | cross2d (const Eigen::Vector2f &a, const Eigen::Vector2f &b) const |
virtual bool | crossCheck (FootstepState::Ptr other, float collision_padding=0) |
return true if this and other are collision free. More... | |
FootstepState (int leg, const Eigen::Affine3f &pose, const Eigen::Vector3f &dimensions, const Eigen::Vector3f &resolution) | |
FootstepState (int leg, const Eigen::Affine3f &pose, const Eigen::Vector3f &dimensions, const Eigen::Vector3f &resolution, int index_x, int index_y, int index_yaw) | |
virtual Eigen::Vector3f | getDimensions () const |
virtual int | getLeg () const |
virtual Eigen::Affine3f | getPose () const |
virtual Eigen::Vector3f | getResolution () const |
virtual int | indexT () |
virtual int | indexX () |
virtual int | indexY () |
virtual FootstepSupportState | isSupportedByPointCloud (const Eigen::Affine3f &pose, pcl::PointCloud< pcl::PointNormal >::Ptr cloud, pcl::KdTreeFLANN< pcl::PointNormal > &tree, pcl::PointIndices::Ptr inliers, const int foot_x_sampling_num, const int foot_y_sampling_num, const double vertex_threshold) |
virtual FootstepSupportState | isSupportedByPointCloudWithoutCropping (const Eigen::Affine3f &pose, pcl::PointCloud< pcl::PointNormal >::Ptr cloud, pcl::KdTreeFLANN< pcl::PointNormal > &tree, pcl::PointIndices::Ptr inliers, const int foot_x_sampling_num, const int foot_y_sampling_num, const double vertex_threshold) |
virtual Eigen::Affine3f | midcoords (const FootstepState &other) |
bool | operator== (FootstepState &other) |
virtual FootstepState::Ptr | projectToCloud (pcl::KdTreeFLANN< pcl::PointNormal > &tree, pcl::PointCloud< pcl::PointNormal >::Ptr cloud, ANNGrid::Ptr grid_search, pcl::search::Octree< pcl::PointNormal > &tree_2d, pcl::PointCloud< pcl::PointNormal >::Ptr cloud_2d, const Eigen::Vector3f &z, unsigned int &error_state, FootstepParameters ¶meters) |
virtual void | setPose (const Eigen::Affine3f &pose) |
template<class PointT > | |
PointT | toPoint () |
virtual jsk_footstep_msgs::Footstep::Ptr | toROSMsg () |
virtual jsk_footstep_msgs::Footstep::Ptr | toROSMsg (const Eigen::Vector3f &ioffset) |
void | vertices (Eigen::Vector3f &a, Eigen::Vector3f &b, Eigen::Vector3f &c, Eigen::Vector3f &d, double collision_padding=0) |
Static Public Member Functions | |
static FootstepState::Ptr | fromROSMsg (const jsk_footstep_msgs::Footstep &f, const Eigen::Vector3f &size, const Eigen::Vector3f &resolution) |
Protected Attributes | |
bool | debug_print_ |
const Eigen::Vector3f | dimensions_ |
int | index_x_ |
int | index_y_ |
int | index_yaw_ |
const int | leg_ |
Eigen::Affine3f | pose_ |
const Eigen::Vector3f | resolution_ |
Definition at line 80 of file footstep_state.h.
Definition at line 83 of file footstep_state.h.
|
inline |
Definition at line 84 of file footstep_state.h.
|
inline |
Definition at line 100 of file footstep_state.h.
pcl::PointIndices::Ptr jsk_footstep_planner::FootstepState::cropPointCloud | ( | pcl::PointCloud< pcl::PointNormal >::Ptr | cloud, |
ANNGrid::Ptr | grid_search, | ||
double | padding_x = 0.0 , |
||
double | padding_y = 0.0 |
||
) |
Definition at line 155 of file footstep_state.cpp.
pcl::PointIndices::Ptr jsk_footstep_planner::FootstepState::cropPointCloudExact | ( | pcl::PointCloud< pcl::PointNormal >::Ptr | cloud, |
pcl::PointIndices::Ptr | near_indices, | ||
double | padding_x = 0.0 , |
||
double | padding_y = 0.0 |
||
) |
Definition at line 112 of file footstep_state.cpp.
|
inline |
Definition at line 118 of file footstep_state.h.
|
virtual |
return true if this and other are collision free.
Definition at line 183 of file footstep_state.cpp.
|
static |
Definition at line 592 of file footstep_state.cpp.
|
inlinevirtual |
Definition at line 207 of file footstep_state.h.
|
inlinevirtual |
Definition at line 206 of file footstep_state.h.
|
inlinevirtual |
Definition at line 200 of file footstep_state.h.
|
inlinevirtual |
Definition at line 215 of file footstep_state.h.
|
inlinevirtual |
Definition at line 220 of file footstep_state.h.
|
inlinevirtual |
Definition at line 218 of file footstep_state.h.
|
inlinevirtual |
Definition at line 219 of file footstep_state.h.
|
virtual |
Definition at line 467 of file footstep_state.cpp.
|
virtual |
Definition at line 539 of file footstep_state.cpp.
|
virtual |
Definition at line 605 of file footstep_state.cpp.
|
inline |
Definition at line 208 of file footstep_state.h.
|
virtual |
Definition at line 210 of file footstep_state.cpp.
|
inlinevirtual |
Definition at line 201 of file footstep_state.h.
|
inline |
Definition at line 171 of file footstep_state.h.
|
virtual |
Definition at line 85 of file footstep_state.cpp.
|
virtual |
Definition at line 96 of file footstep_state.cpp.
|
inline |
Definition at line 178 of file footstep_state.h.
|
protected |
Definition at line 249 of file footstep_state.h.
|
protected |
Definition at line 243 of file footstep_state.h.
|
protected |
Definition at line 246 of file footstep_state.h.
|
protected |
Definition at line 247 of file footstep_state.h.
|
protected |
Definition at line 248 of file footstep_state.h.
|
protected |
Definition at line 245 of file footstep_state.h.
|
protected |
Definition at line 242 of file footstep_state.h.
|
protected |
Definition at line 244 of file footstep_state.h.