finished pulling while loops out of sendGoal so that all polling of robot happens in main loop