Zaslat SMS: Laser scanner based heading angle and distance estimation