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
do you have any numbers on the performance penalty of switching all this from int to double?