suggested fix for rt80329

Hello,

I submited a bug report earlier today.
Here's the suggested fix & and a regression test.

Hope it's okay and you merge it shortly, as this has been causing me some troubles lately.

Thanks.