Only accept goals after reception of controller feedback. Fix #85.