Hi NonConformalMapping,
i'm working with an arduino mega 2560 and a mpu6050 imu, and i'm experiencing issues much similar to yours, i'm actually using rosserial arduino to send the YPR over serial connection.
Did you eventually solve the problem? Please share