Added grid to help visualize
Make larger the variance representation for the drone position
Draw the feature displacement in magenta