#include <ClearpathDemoTools.h>
Public Member Functions | |
ClearpathDemoTools () | |
void | InitExplore (double _lin_speed, double _ang_speed, double _cam_height, double _cam_z_trans, double _wall_buffer, int _random_walk) |
void | InitTrack (double _lin_speed, double _ang_speed, double _cam_height, double _cam_z_trans, double _window_size) |
void | NIUpdate (float *px, float *py, float *pz, unsigned int len, double *return_lin_vel, double *return_ang_vel) |
Twist | Update (PointCloud *cloud, PointCloud *result) |
virtual | ~ClearpathDemoTools () |
Static Public Member Functions | |
static Twist | DetermineVelocity (double x, double z, double speed) |
static bool | PlaneLS (PointCloud *cloud, double *normal_coeff) |
static bool | PlaneRANSAC (PointCloud *cloud, double *normal_coeff, bool match_coeff) |
static void | PlaneSegment (PointCloud *cloud, PointCloud *plane, PointCloud *seg_cloud, double *norm, double thresh) |
static bool | TransformByNormal (PointCloud *cloud, PointCloud *cloud_out, double *normal_coeff) |
static void | VerticalCut (PointCloud *cloud, PointCloud *cloud_out, double min, double max, int skim_factor) |
Public Attributes | |
double | ang_speed |
double | base_normal [4] |
double | cam_height |
double | cam_z_trans |
PointCloud | cloudCopy |
PointCloud | cloudCut |
unsigned int | drawInc |
PointCloud | final |
double | incX |
double | incZ |
Square * | init_map |
double | last_normal [4] |
double | lin_speed |
Square * | mapc |
double | maxAng |
double | maxX |
double | maxZ |
double | minAng |
double | minX |
double | minZ |
int | mode |
bool | normal_initialized |
unsigned int | numIncX |
unsigned int | numIncZ |
unsigned int | obstacleThreshold |
bool | old_clearpath |
int | old_dir |
PointCloud | plane |
int | random_walk |
PointCloud | seg |
double | targetW |
double | targetX |
double | targetZ |
double | wall_buffer |
Private Member Functions | |
void | getBins (double x, double z, unsigned int *binX, unsigned int *binZ) |
void | Init (double _lin_speed, double _ang_speed, double _cam_height, double _cam_z_trans, unsigned int _numIncX, unsigned int _numIncZ) |
Static Private Member Functions | |
static bool | GetPlaneFromRnd3 (PointCloud *cloud, double *normal_coeff) |
Definition at line 61 of file ClearpathDemoTools.h.
ClearpathDemoTools::ClearpathDemoTools | ( | ) |
Definition at line 266 of file ClearpathDemoTools.cpp.
ClearpathDemoTools::~ClearpathDemoTools | ( | ) | [virtual] |
Definition at line 271 of file ClearpathDemoTools.cpp.
Twist ClearpathDemoTools::DetermineVelocity | ( | double | x, | |
double | z, | |||
double | speed | |||
) | [static] |
Definition at line 239 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::getBins | ( | double | x, | |
double | z, | |||
unsigned int * | binX, | |||
unsigned int * | binZ | |||
) | [private] |
Definition at line 365 of file ClearpathDemoTools.cpp.
bool ClearpathDemoTools::GetPlaneFromRnd3 | ( | PointCloud * | cloud, | |
double * | normal_coeff | |||
) | [static, private] |
Definition at line 18 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::Init | ( | double | _lin_speed, | |
double | _ang_speed, | |||
double | _cam_height, | |||
double | _cam_z_trans, | |||
unsigned int | _numIncX, | |||
unsigned int | _numIncZ | |||
) | [private] |
Definition at line 278 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::InitExplore | ( | double | _lin_speed, | |
double | _ang_speed, | |||
double | _cam_height, | |||
double | _cam_z_trans, | |||
double | _wall_buffer, | |||
int | _random_walk | |||
) |
Definition at line 319 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::InitTrack | ( | double | _lin_speed, | |
double | _ang_speed, | |||
double | _cam_height, | |||
double | _cam_z_trans, | |||
double | _window_size | |||
) |
Definition at line 343 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::NIUpdate | ( | float * | px, | |
float * | py, | |||
float * | pz, | |||
unsigned int | len, | |||
double * | return_lin_vel, | |||
double * | return_ang_vel | |||
) |
Definition at line 372 of file ClearpathDemoTools.cpp.
bool ClearpathDemoTools::PlaneLS | ( | PointCloud * | cloud, | |
double * | normal_coeff | |||
) | [static] |
Definition at line 136 of file ClearpathDemoTools.cpp.
bool ClearpathDemoTools::PlaneRANSAC | ( | PointCloud * | cloud, | |
double * | normal_coeff, | |||
bool | match_coeff | |||
) | [static] |
Definition at line 74 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::PlaneSegment | ( | PointCloud * | cloud, | |
PointCloud * | plane, | |||
PointCloud * | seg_cloud, | |||
double * | norm, | |||
double | thresh | |||
) | [static] |
Definition at line 176 of file ClearpathDemoTools.cpp.
bool ClearpathDemoTools::TransformByNormal | ( | PointCloud * | cloud, | |
PointCloud * | cloud_out, | |||
double * | normal_coeff | |||
) | [static] |
Definition at line 198 of file ClearpathDemoTools.cpp.
Twist ClearpathDemoTools::Update | ( | PointCloud * | cloud, | |
PointCloud * | result | |||
) |
Definition at line 386 of file ClearpathDemoTools.cpp.
void ClearpathDemoTools::VerticalCut | ( | PointCloud * | cloud, | |
PointCloud * | cloud_out, | |||
double | min, | |||
double | max, | |||
int | skim_factor | |||
) | [static] |
Definition at line 226 of file ClearpathDemoTools.cpp.
Definition at line 107 of file ClearpathDemoTools.h.
double ClearpathDemoTools::base_normal[4] |
Definition at line 115 of file ClearpathDemoTools.h.
Definition at line 108 of file ClearpathDemoTools.h.
Definition at line 109 of file ClearpathDemoTools.h.
Definition at line 118 of file ClearpathDemoTools.h.
Definition at line 119 of file ClearpathDemoTools.h.
unsigned int ClearpathDemoTools::drawInc |
Definition at line 132 of file ClearpathDemoTools.h.
Definition at line 122 of file ClearpathDemoTools.h.
double ClearpathDemoTools::incX |
Definition at line 130 of file ClearpathDemoTools.h.
double ClearpathDemoTools::incZ |
Definition at line 131 of file ClearpathDemoTools.h.
Definition at line 111 of file ClearpathDemoTools.h.
double ClearpathDemoTools::last_normal[4] |
Definition at line 114 of file ClearpathDemoTools.h.
Definition at line 106 of file ClearpathDemoTools.h.
Definition at line 112 of file ClearpathDemoTools.h.
double ClearpathDemoTools::maxAng |
Definition at line 125 of file ClearpathDemoTools.h.
double ClearpathDemoTools::maxX |
Definition at line 127 of file ClearpathDemoTools.h.
double ClearpathDemoTools::maxZ |
Definition at line 129 of file ClearpathDemoTools.h.
double ClearpathDemoTools::minAng |
Definition at line 124 of file ClearpathDemoTools.h.
double ClearpathDemoTools::minX |
Definition at line 126 of file ClearpathDemoTools.h.
double ClearpathDemoTools::minZ |
Definition at line 128 of file ClearpathDemoTools.h.
Definition at line 101 of file ClearpathDemoTools.h.
Definition at line 116 of file ClearpathDemoTools.h.
unsigned int ClearpathDemoTools::numIncX |
Definition at line 103 of file ClearpathDemoTools.h.
unsigned int ClearpathDemoTools::numIncZ |
Definition at line 104 of file ClearpathDemoTools.h.
unsigned int ClearpathDemoTools::obstacleThreshold |
Definition at line 133 of file ClearpathDemoTools.h.
Definition at line 149 of file ClearpathDemoTools.h.
Definition at line 150 of file ClearpathDemoTools.h.
Definition at line 121 of file ClearpathDemoTools.h.
Definition at line 147 of file ClearpathDemoTools.h.
Definition at line 120 of file ClearpathDemoTools.h.
double ClearpathDemoTools::targetW |
Definition at line 141 of file ClearpathDemoTools.h.
double ClearpathDemoTools::targetX |
Definition at line 139 of file ClearpathDemoTools.h.
double ClearpathDemoTools::targetZ |
Definition at line 140 of file ClearpathDemoTools.h.
Definition at line 148 of file ClearpathDemoTools.h.