adapting the code to command the arm with wpi_jaco package