RRTNode *RRTBase::nn(RRTNode *rs)
{
int iy = this->YI(rs);
+ float iy_step = (this->VMAX - this->VMIN) / IYSIZE;
struct mcnn nn;
nn.nn = nullptr;
nn.mc = 9999;
unsigned int i = 0; // vector step
unsigned int j = 0; // array step
int iyj = 0;
- while (nn.mc > j * IYSTEP) {
+ while (nn.mc > j * iy_step) {
iyj = (int) (iy + j);
if (iyj >= IYSIZE)
iyj = IYSIZE - 1;
{
std::vector<RRTNode *> nvs;
unsigned int iy = this->YI(node);
- unsigned int iy_dist = floor(dist / IYSTEP) + 1;
+ float iy_step = (this->VMAX - this->VMIN) / IYSIZE;
+ unsigned int iy_dist = floor(dist / iy_step) + 1;
unsigned int i = 0; // vector index
unsigned int j = 0; // array index
unsigned int jmin = 0; // minimal j index
#define NOFNODES 20000
#define IXSIZE 100
-#define IXSTEP (1.0 * ((HMAX) - (HMIN)) / IXSIZE)
-#define IXI(x) ({ __typeof__ (x) _x = (x); \
- std::abs((int) floor(_x / IXSTEP)); })
#define IYSIZE 100
-#define IYSTEP (1.0 * ((VMAX) - (VMIN)) / IYSIZE)
-#define IYI(y) ({ \
- __typeof__ (y) _y = (y); \
- (int) floor((_y - VMIN) / IYSTEP); \
-})
#define GLVERTEX(n) ((n)->x() * glplwscale), ((n)->y() * glplhscale)