Added function to check for collisions along an arc

[rohbotics]

Basic implementation of collision checking along an arc trajectory for smooth turning.

[MoffKalast]

Now I see exactly what you meant with polar coordinate checking, it's quite a neat trick. I suppose we may want to add a tiny bit of padding to robot_width if that's not yet taken into account by the yaml.