Also. function: setMap() is time-costy, when update 3D(x, y, theta) lookup table for astar search!
Also. function: setMap() is time-costy, when update 3D(x, y, theta) lookup table for astar search!