Fixed Yamamoto QR test completely and added benchmark