Accurate Bresenham raytracing implementation and clearing for corner cases

Changes / fixes clearing with Bresenham raytracing using a more accurate version
Adds parameters for accuracy settings
Adds parameter for including corner cases into clearing

See also https://github.com/ros-planning/navigation/issues/267
should this actually be here?