[localisation] Makes implementation of laser tracking algorithm better.
[localization] Fixes error in error computation.