dynamixel_servo: modified the abilities to control it