Only accept goals after reception of controller feedback. Fix #85.
Merge pull request #86 from gavanderhoorn/issue85_within_constraints_segfault

Fix for issue #85: reject all goals until feedback has been received