Vision: Implement block publishing with dynamixel yaw