Add laser scan matcher, change laser frame