dynamixel_up with extra joint and visual