Added in some dynamixel functionality