merging dynamixel code