Turn detection and (maybe) mapping working