Working nose_follow along with a new (3rd) algo for qr planning.