Added a margin along the sensor line in inverse localization.

When ground points are close to first or last pixel, we need to be able
to compute angles sightly after line end, so a small 5 pixels margin has
been added in the search algorithm.