Improving Path Planning Methods in 2D Grid Maps