x and heading is still NAN, but otherwise works well