[U-Boot] AT91 Rework