bool RRTBase::glplot()
{
#if USE_GL > 0
+ float glplwscale = 1.0 / ((this->VMAX) - (this->VMIN));
+ float glplhscale = 1.0 / ((this->HMAX) - (this->HMIN));
glClear(GL_COLOR_BUFFER_BIT);
glLineWidth(1);
glPointSize(1);
glColor3f(0.5, 0.5, 0.5);
BicycleCar bc(tmp->x(), tmp->y(), tmp->h());
glVertex2f(
- bc.lfx() * GLPLWSCALE,
- bc.lfy() * GLPLHSCALE
+ bc.lfx() * glplwscale,
+ bc.lfy() * glplhscale
);
glVertex2f(
- bc.lrx() * GLPLWSCALE,
- bc.lry() * GLPLHSCALE
+ bc.lrx() * glplwscale,
+ bc.lry() * glplhscale
);
glVertex2f(
- bc.lrx() * GLPLWSCALE,
- bc.lry() * GLPLHSCALE
+ bc.lrx() * glplwscale,
+ bc.lry() * glplhscale
);
glVertex2f(
- bc.rrx() * GLPLWSCALE,
- bc.rry() * GLPLHSCALE
+ bc.rrx() * glplwscale,
+ bc.rry() * glplhscale
);
glVertex2f(
- bc.rrx() * GLPLWSCALE,
- bc.rry() * GLPLHSCALE
+ bc.rrx() * glplwscale,
+ bc.rry() * glplhscale
);
glVertex2f(
- bc.rfx() * GLPLWSCALE,
- bc.rfy() * GLPLHSCALE
+ bc.rfx() * glplwscale,
+ bc.rfy() * glplhscale
);
}
}
(int) floor((_y - VMIN) / IYSTEP); \
})
+#define GLVERTEX(n) ((n)->x() * glplwscale), ((n)->y() * glplhscale)
+
class Cell {
private:
std::vector<RRTNode *> nodes_;
#include "rrtnode.h"
-#define GLPLWSCALE (1.0 / ((VMAX) - (VMIN)))
-#define GLPLHSCALE (1.0 / ((HMAX) - (HMIN)))
-
-#define GLVERTEX(n) ((n)->x() * GLPLWSCALE), ((n)->y() * GLPLHSCALE)
-
RRTNode *sa1();
RRTNode *sa2(float bx, float by, float br);