ARM: at91: spl: Adjust switching to oscillator for SAMA5D2