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