ARM: 5965/1: Fix soft lockup in at91 udc driver