dubinShot doen't have on grid check, which may result to some nodes out of map

[yslenjoy]

The dubinsShot function in algorithm.cpp only check whether the node isTraversable, and it doesn't check if the node isOnGrid or not, which may result to node out of map