command pr2 arm in cpp