Fix and test for RT91715