[demoGrasp]: in reach state use goToPoseSync()