Behaviours 1

[grayal]

First set of behaviours:

• course setting (heading and speed)
• waypoint following
• path tracking