On 28.06.22 22:38, Sam Ravnborg wrote: > Add xload support to at91sam9263 similar to what is already > present for the sama5d3. > The xload supports reading barebox.bin from a SDCARD from the > PBL and load the full barebox.bin and starts it. Reviewed-by: Ahmad Fatoum <a.fatoum@xxxxxxxxxxxxxx> > > Signed-off-by: Sam Ravnborg <sam@xxxxxxxxxxxx> > --- > arch/arm/mach-at91/Makefile | 1 + > arch/arm/mach-at91/at91sam9_xload_mmc.c | 118 ++++++++++++++++++++++++ > arch/arm/mach-at91/include/mach/xload.h | 4 + > 3 files changed, 123 insertions(+) > create mode 100644 arch/arm/mach-at91/at91sam9_xload_mmc.c > > diff --git a/arch/arm/mach-at91/Makefile b/arch/arm/mach-at91/Makefile > index 12e64291b..b171d682f 100644 > --- a/arch/arm/mach-at91/Makefile > +++ b/arch/arm/mach-at91/Makefile > @@ -17,6 +17,7 @@ obj-y += at91sam9_reset.o > obj-y += at91sam9g45_reset.o > obj-pbl-$(CONFIG_HAVE_AT91_DDRAMC) += ddramc.o > pbl-$(CONFIG_AT91_MCI_PBL) += xload-mmc.o > +pbl-$(CONFIG_AT91_MCI_PBL) += at91sam9_xload_mmc.o > > obj-$(CONFIG_AT91SAM9_SMC) += sam9_smc.o > obj-$(CONFIG_HAVE_AT91SAM9_RST) += at91sam9_rst.o > diff --git a/arch/arm/mach-at91/at91sam9_xload_mmc.c b/arch/arm/mach-at91/at91sam9_xload_mmc.c > new file mode 100644 > index 000000000..64266757d > --- /dev/null > +++ b/arch/arm/mach-at91/at91sam9_xload_mmc.c > @@ -0,0 +1,118 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > +/* SPDX-FileCopyrightText: 2022 Sam Ravnborg */ > + > +#include <debug_ll.h> > +#include <common.h> > +#include <pbl.h> > + > +#include <linux/sizes.h> > +#include <asm/cache.h> > + > +#include <mach/at91_pmc_ll.h> > +#include <mach/at91sam9263.h> > +#include <mach/at91sam926x.h> > +#include <mach/hardware.h> > +#include <mach/iomux.h> > +#include <mach/xload.h> > +#include <mach/gpio.h> > + > +typedef void (*func)(int zero, int arch, void *params); > + > +/* > + * Load barebox.bin and start executing the first byte in the barebox image. > + * barebox.bin is loaded to AT91_CHIPSELECT_1. > + * > + * To be able to load barebox.bin do a minimal init of the pheriferals > + * used by MCI. > + * This functions runs in PBL code and uses the PBL variant of the > + * atmel_mci driver. > + */ > +void __noreturn sam9263_atmci_start_image(u32 mmc_id, unsigned int clock, > + bool slot_b) > +{ > + void __iomem *pio = IOMEM(AT91SAM9263_BASE_PIOA); > + void *buf = (void *)AT91_CHIPSELECT_1; > + void __iomem *base; > + struct pbl_bio bio; > + int ret; > + > + at91_pmc_enable_periph_clock(IOMEM(AT91SAM926X_BASE_PMC), AT91SAM9263_ID_PIOA); > + > + if (mmc_id == 0) { > + base = IOMEM(AT91SAM9263_BASE_MCI0); > + > + /* CLK */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA12), AT91_MUX_PERIPH_A, 0); > + > + if (!slot_b) { > + /* CMD */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA1), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + > + /* DAT0 to DAT3 */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA0), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA3), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA4), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA5), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + } else { > + /* CMD */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA16), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + > + /* DAT0 to DAT3 */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA17), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA18), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA19), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA20), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + } > + > + at91_pmc_enable_periph_clock(IOMEM(AT91SAM926X_BASE_PMC), AT91SAM9263_ID_MCI0); > + } else { > + base = IOMEM(AT91SAM9263_BASE_MCI1); > + > + /* CLK */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA6), AT91_MUX_PERIPH_A, 0); > + > + if (!slot_b) { > + /* CMD */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA7), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + > + /* DAT0 to DAT3 */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA8), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA9), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA10), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA11), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + } else { > + /* CMD */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA21), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + > + /* DAT0 to DAT3 */ > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA22), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA23), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA24), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + at91_mux_pio_pin(pio, pin_to_mask(AT91_PIN_PA25), AT91_MUX_PERIPH_A, GPIO_PULL_UP); > + } > + > + at91_pmc_enable_periph_clock(IOMEM(AT91SAM926X_BASE_PMC), AT91SAM9263_ID_MCI1); > + } > + > + ret = at91_mci_bio_init(&bio, base, clock, (int)slot_b); > + if (ret) { > + pr_err("atmci_start_image: bio init faild: %d\n", ret); > + goto out_panic; > + } > + > + /* at91sam9x do not support high capacity */ > + at91_mci_bio_set_highcapacity(false); > + > + ret = pbl_fat_load(&bio, "barebox.bin", buf, SZ_16M); > + if (ret < 0) { > + pr_err("pbl_fat_load: error %d\n", ret); > + goto out_panic; > + } > + > + sync_caches_for_execution(); > + > + ((func)buf)(0, 0, NULL); > + > +out_panic: > + panic("FAT chainloading failed\n"); > +} > diff --git a/arch/arm/mach-at91/include/mach/xload.h b/arch/arm/mach-at91/include/mach/xload.h > index 488279c1a..82db65e30 100644 > --- a/arch/arm/mach-at91/include/mach/xload.h > +++ b/arch/arm/mach-at91/include/mach/xload.h > @@ -15,4 +15,8 @@ int at91_mci_bio_init(struct pbl_bio *bio, void __iomem *base, > unsigned int clock, unsigned int slot); > void at91_mci_bio_set_highcapacity(bool highcapacity_card); > > +void __noreturn sam9263_atmci_start_image(u32 mmc_id, unsigned int clock, > + bool slot_b); > + > + > #endif /* __MACH_XLOAD_H */ -- Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |