Further fixed Kalman Filter localization, it works well now assuming that boat has sensors for speed and heading. Sensors can be quite noisy.
true_sailboat.provide_measurements now returns speed measurement.
Changed how measurement errors is calculated for radius. It now returns a percentage of true radius instead of true_radius + error.  This was needed because before, radius error was large when the boat was close to the pole.