maybe fixed bad quaterions in approach poses