Modified laser_scan_matcher to use odometry