TODO: test pr2 controller unit step responses
