#include <iri_bspline_navfn/navfn.h>#include <ros/console.h>#include <costmap_2d/costmap_2d_ros.h>
Go to the source code of this file.
Namespaces | |
| namespace | iri_bspline_navfn |
Defines | |
| #define | INVSQRT2 0.707106781 |
| #define | INVSQRT2 0.707106781 |
| #define | push_cur(n) |
| #define | push_next(n) |
| #define | push_over(n) |
Functions | |
| int | iri_bspline_navfn::create_nav_plan_astar (COSTTYPE *costmap, int nx, int ny, int *goal, int *start, float *plan, int nplan) |
{ if (n>=0 && n<ns && !pending[n] && \
costarr[n]<COST_OBS && curPe<PRIORITYBUFSIZE) \
{ curP[curPe++]=n; pending[n]=true; }}
{ if (n>=0 && n<ns && !pending[n] && \
costarr[n]<COST_OBS && nextPe<PRIORITYBUFSIZE) \
{ nextP[nextPe++]=n; pending[n]=true; }}