add the arm2 teach cmd the rpy