add test code for pr2-send-joints-test.l