Working nose_follow along with a new (3rd) algo for qr planning.
Merge pull request #134 from AGV-IIT-KGP/new_qr

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