Made avoidobstacles more generic (now works with an arbitrary number of sensors)
Added a Hold controller to use when the goal is reached. Moved stopping code to supervisor