uint8_t write_data[4] = {id, cmd, 0x14, CMD_EOF};
uint8_t read_data[6];
int ret = dynamixel_write(write_data, 4, read_data, 6);
uint8_t write_data[4] = {id, cmd, 0x14, CMD_EOF};
uint8_t read_data[6];
int ret = dynamixel_write(write_data, 4, read_data, 6);