Add a pure-pursuit path follower

[kmolan]

Add a pure-pursuit controller that follows a path given the current pose.

Done when: it tracks a sample path within tolerance.

Depends on #66

[kmolan]

on it