mfd: Fix usbhs_enable error handling