returning trajectory controller's opinion on whether the goal has been reached or not. closes #4
introduced some hysteresis between turning to final orientation and
turning towards the next bubble. closes #3